多个传感器一起工作时,数据内容正确也可能得到错误结果:相机看到的是上一瞬间,里程计却描述的是当前瞬间。融合前先确认各条数据何时采集,以及使用的是同一个时钟。
先区分三个时间
- 采集时间:物理测量实际发生的时刻。
- 接收时间:程序收到消息的时刻。
- 处理时间:算法完成计算或发布结果的时刻。
网络传输和排队会使接收时间晚于采集时间。拿接收时间代替采集时间,运动时容易出现空间错位。
五步排查
- 查看每条消息的时间戳和坐标系标识。
- 确认各设备使用同一时钟来源;跨机器时检查时间同步。
- 记录相邻消息的时间差,找出丢帧、突发和乱序。
- 比较采集到接收、接收到处理的延迟,定位瓶颈。
- 在机器人静止和运动两种状态下分别复现问题。若仅运动时错位,重点查时间同步与位姿变换。
留下可复现证据
保存一小段原始数据、设备配置、系统时间和复现步骤。只截一张结果图往往不足以区分是标定误差、时钟偏差还是处理延迟。
提醒:时间戳字段的含义取决于驱动实现。排查时要核对驱动文档或代码,不要只依据字段名称猜测。
还没有评论,欢迎提出第一个问题。