真实面经题目 · 原创解析
Tracking 中目标速度通常如何获取?
这题考目标跟踪里的速度估计来源,重点是测量差分、滤波状态估计、传感器直接测速、坐标补偿和误差诊断。
真实面经题目 · 原创解析
这题考目标跟踪里的速度估计来源,重点是测量差分、滤波状态估计、传感器直接测速、坐标补偿和误差诊断。
Tracking 里的目标速度通常有几类来源。第一是基于连续帧位置差分,用检测框、3D box 或点云聚类中心在统一坐标系下做位移除以时间,但要补偿自车运动和时间戳误差。第二是把速度作为滤波器状态,比如 Kalman Filter、EKF 或 UKF 中用匀速、匀加速、CTRV 等运动模型预测,再用观测更新,得到更平滑的速度。第三是利用传感器直接或间接测速,例如毫米波雷达 Doppler 速度、激光点云帧间配准、光流或视觉时序估计。工程上要关注坐标系转换、检测抖动、目标关联错误、遮挡丢帧、传感器同步、自车定位误差和异常速度约束。速度不是简单两帧相减,最后要通过轨迹连续性、速度误差、碰撞预测和下游规划稳定性验证。
最直观做法是用连续帧目标位置变化除以时间间隔。前提是位置在同一坐标系下,并且已经补偿自车运动。检测框抖动、帧率变化和时间戳不准都会让差分速度非常噪声。
跟踪系统通常维护位置、速度、朝向、加速度等状态,用运动模型预测下一帧,再用检测观测更新。Kalman 类滤波能平滑噪声并处理短时遮挡,但模型假设不匹配时会产生滞后或错误速度。
毫米波雷达可提供 Doppler 径向速度,对速度估计很有价值;激光雷达可通过点云配准或目标几何运动估计速度;视觉可用光流、时序特征或多目深度变化辅助。不同传感器给出的速度维度和误差不同,需要融合。
自动驾驶场景里传感器在运动,如果不扣除 ego motion,静止路边物体也会被估计成运动目标。需要结合车辆里程计、IMU、定位或 CAN 速度,把目标状态转换到世界、车体或 BEV 坐标系中一致更新。
速度估计依赖目标 ID 连续性。遮挡、交叉、近距离并行和检测漏帧会造成 ID switch,一旦关联错,位置突变会带来异常速度。工程上要用 gating、外观/几何特征、速度先验和异常值剔除保护跟踪状态。
速度估计的好坏要看轨迹平滑、速度误差、加速度合理性、碰撞时间 TTC、规划决策稳定性和误刹漏刹情况。只看单帧速度数值不够,要在复杂交通场景中验证连续性和边界条件。
检测位置有噪声,帧间时间可能不稳定,自车也在运动。直接差分会放大抖动,遇到遮挡或关联错误时会产生异常速度。
毫米波雷达常给径向速度,对横向速度约束弱,还会受多径、虚警、目标分辨和传感器安装角影响,需要和其他传感器融合。
可以用物理加速度约束、滤波协方差、关联 gating、异常值剔除和短时状态冻结,必要时降低该目标置信度。