根据传回来的角速度和线速度 优化显示倒车影像,未测试

This commit is contained in:
mmc
2026-10-21 14:51:52 +08:00
parent 2758dd9643
commit 6bd497c9b5
2 changed files with 96 additions and 26 deletions

View File

@@ -3,6 +3,10 @@ import React, { useEffect, useRef } from 'react';
type GuideLineProps = {
direction: 'forward' | 'reverse';
steer: number;
/** 实时线速度(m/s):前进为正,后退为负。缺省时回退到 steer */
linearSpeed?: number;
/** 实时角速度(rad/s):左转为正,右转为负。缺省时回退到 steer */
angularSpeed?: number;
bottomGap?: number;
topGap?: number;
visible?: boolean;
@@ -19,6 +23,8 @@ type Point = {
const CarReverseGuideLine: React.FC<GuideLineProps> = ({
direction,
steer,
linearSpeed,
angularSpeed,
bottomGap,
topGap,
visible = true,
@@ -28,6 +34,10 @@ const CarReverseGuideLine: React.FC<GuideLineProps> = ({
const containerRef = useRef<HTMLDivElement>(null);
const steerRef = useRef(steer);
const linearSpeedRef = useRef(linearSpeed);
const angularSpeedRef = useRef(angularSpeed);
// 平滑后的转向量:> 0 右移,< 0 左移,0 为直行
const turnRef = useRef(0);
const directionRef = useRef(direction);
const flashRef = useRef(chevronFlash);
const gapRef = useRef({ bottomGap, topGap });
@@ -36,12 +46,16 @@ const CarReverseGuideLine: React.FC<GuideLineProps> = ({
// 更新参数,不触发 React 组件重新渲染
useEffect(() => {
steerRef.current = steer;
linearSpeedRef.current = linearSpeed;
angularSpeedRef.current = angularSpeed;
directionRef.current = direction;
flashRef.current = chevronFlash;
gapRef.current = { bottomGap, topGap };
visibleRef.current = visible;
}, [
steer,
linearSpeed,
angularSpeed,
direction,
chevronFlash,
bottomGap,
@@ -87,30 +101,67 @@ const CarReverseGuideLine: React.FC<GuideLineProps> = ({
resizeObserver.observe(container);
resize();
/**
* 计算车道中心线。
* steer < 0 左转,steer > 0 右转。
/**
* 计算当前转向量(-1 左 … 0 直行 … +1 右)。
*
* 优先使用实时状态:曲率 κ = ω / v
* linear_speed : 前进为正,后退为负(只取大小参与曲率,方向由视角决定)
* angular_speed : 左转为正,右转为负
* 曲率 > 0(左转)对应画面左侧,因此转向量取负号;
* 静止 / 极低速时不产生行驶轨迹,按直行处理。
* 无实时数据时回退到方向盘转角 steer。
*/
const computeTurn = () => {
const v = linearSpeedRef.current;
const w = angularSpeedRef.current;
const hasRealtime =
typeof v === 'number' &&
Number.isFinite(v) &&
typeof w === 'number' &&
Number.isFinite(w);
if (!hasRealtime) {
const angle = Math.max(
-45,
Math.min(45, steerRef.current)
);
// 方向盘转角转换为曲率响应
return Math.tan((angle * Math.PI) / 180);
}
// 静止 / 极低速:没有行驶轨迹,保持直线
if (Math.abs(v) < 0.03) return 0;
// 低速时限制分母,避免曲率被放大到满量程
const speed = Math.max(Math.abs(v), 0.15);
// 曲率:ω / v,正值左转
const kappa = w / speed;
// 满量程曲率(约对应 1m 转弯半径)
const KAPPA_FULL_SCALE = 1.0;
const normalized = Math.max(
-1,
Math.min(1, kappa / KAPPA_FULL_SCALE)
);
// 左转为正 → 画面左侧为负偏移
return -normalized;
};
/**
* 计算转向后的车道中心
*
* forward:
* 下方近端相对稳定,上方远端逐渐弯曲
*
* reverse:
* 上方远端相对稳定,下方近端逐渐弯曲
*/
* 计算转向后的车道中心。
*
* forward:
* 下方近端相对稳定,上方远端逐渐弯曲
*
* reverse:
* 上方远端相对稳定,下方近端逐渐弯曲
*/
const getCenterX = (progress: number) => {
const angle = Math.max(
-45,
Math.min(45, steerRef.current)
);
// 方向盘转角转换为曲率响应
const turn = Math.tan(
(angle * Math.PI) / 180
);
// progress: 0 = 顶部远端,1 = 底部近端
let curveProgress: number;
@@ -123,14 +174,13 @@ const CarReverseGuideLine: React.FC<GuideLineProps> = ({
}
// 平滑曲率,避免轨迹弯曲突兀
const curveFactor =
curveProgress * curveProgress;
const curveFactor = curveProgress * curveProgress;
// 转向最大横向偏移
const maxOffset = width * 0.40;
const offset =
turn *
turnRef.current *
maxOffset *
curveFactor;
@@ -388,6 +438,12 @@ const CarReverseGuideLine: React.FC<GuideLineProps> = ({
lastTime = time;
animationTime += delta;
// 实时数据抖动较大,按帧平滑转向量,避免辅助线抖动
const targetTurn = computeTurn();
turnRef.current +=
(targetTurn - turnRef.current) *
Math.min(1, delta * 8);
ctx.clearRect(0, 0, width, height);
// 底层车道线

View File

@@ -2797,7 +2797,13 @@ export default function DeviceStatusPage() {
<AgrtcRoomRobot CHANNEL={"41-thream03"} />
<CarReverseGuideLine direction="forward" steer={steerXY.x * 45} visible={isVideoPlaying} />
<CarReverseGuideLine
direction="forward"
steer={steerXY.x * 45}
linearSpeed={Number(runningStatus?.linear_speed ?? runningStatus?.linearSpeed)}
angularSpeed={Number(runningStatus?.angular_speed ?? runningStatus?.angularSpeed)}
visible={isVideoPlaying}
/>
</div>
@@ -2821,7 +2827,15 @@ export default function DeviceStatusPage() {
/>
{mowerView === 'back' && (<CarReverseGuideLine direction="reverse" steer={steerXY.x * 45} visible={isVideoPlaying} />)}
{mowerView === 'back' && (
<CarReverseGuideLine
direction="reverse"
steer={steerXY.x * 45}
linearSpeed={Number(runningStatus?.linear_speed ?? runningStatus?.linearSpeed)}
angularSpeed={Number(runningStatus?.angular_speed ?? runningStatus?.angularSpeed)}
visible={isVideoPlaying}
/>
)}
</div>