机器人 / 系统课时
检查 cmd_vel 与里程计偏差
检查 cmd_vel 与里程计偏差
导航路径看起来正常,机器人却走得偏慢、拐弯过头或突然停顿时,可以同时检查底盘收到的速度命令、里程计反馈和 Gazebo 中的实际位移。本课用只读 ROS 2 命令定位限速、延迟与轮地打滑,而不是直接改控制器增益。
学习目标
- 找到 Nav2 速度命令到仿真底盘的实际话题链路。
- 计算直线与转向速度的命令—反馈偏差。
- 区分速度限制、里程计更新滞后和打滑,并完成复测。
先确认比较的是哪条速度命令
以 ROS 2 Jazzy 的常见 Nav2 bringup 为例,Controller Server 的输出可重映射为 /cmd_vel_nav,Velocity Smoother 输出 /cmd_vel_smoothed,启用 Collision Monitor 时再输出 /cmd_vel 给底盘。具体话题由 launch 重映射决定;如果没有这些中间话题,不要据此判定节点故障。

在直线、远离障碍和终点的路段观察,避免避障或到点减速干扰判断。先确认实际发送到底盘的话题;Jazzy Nav2 默认使用 geometry_msgs/msg/Twist,但开启 enable_stamped_cmd_vel 后可能是 TwistStamped,消息类型必须与底盘订阅端一致。
采集命令、里程计与发布频率
启动 Gazebo、Nav2 并发送一个安全的导航目标后,在新终端执行以下只读检查。/cmd_vel 和 /odom 是本例话题名;若前一步发现了命名空间或重映射,应替换成现场名称。
source /opt/ros/jazzy/setup.bash
ros2 topic list | grep -E 'cmd_vel|odom'
ros2 topic type /cmd_vel
ros2 topic type /odom
ros2 topic info /cmd_vel -v
ros2 topic echo /cmd_vel --once
ros2 topic echo /odom --once预期结果:默认情况下,两个类型依次为 geometry_msgs/msg/Twist、nav_msgs/msg/Odometry;消息分别含有 linear.x、angular.z 以及 twist.twist.linear.x、twist.twist.angular.z。数值和端点数量随运行状态变化。若采用 TwistStamped,命令速度字段改在 twist.linear.x 与 twist.angular.z 下。
机器人运动时再检查实际频率:
ros2 topic hz /cmd_vel预期结果:持续出现 average rate 等统计值;按 Ctrl+C 结束。随后同样运行 ros2 topic hz /odom。例如控制频率设为 20 Hz 时,其周期约 0.05 秒;若里程计长期只有 5 Hz(约 0.2 秒一帧),要先检查仿真插件与消息桥,而不是先提高控制频率。
用稳定路段的数据定位偏差
取直线匀速约 2~3 秒内邻近时刻的读数,比较命令与 /odom 的 linear.x;原地转向则比较 angular.z,单位分别为 m/s 与 rad/s。例如最终命令为 0.20 m/s,里程计为 0.12 m/s,绝对差是 0.08 m/s,相对命令误差为 40%。这只是排障算例,不是 Nav2 内置报警阈值;启动和制动阶段不能用它判定故障。
| 观测现象 | 优先排查 |
|---|---|
/cmd_vel_nav 为 0.25,/cmd_vel_smoothed 为 0.18 m/s,稳态仍持续 |
平滑器 max_velocity 等速度上限;若仅加速阶段偏低,再查 max_accel |
/cmd_vel_smoothed 有速度,最终 /cmd_vel 被降至零 |
Collision Monitor 的停止区域、传感器超时或其他安全限速 |
最终命令与 /odom 接近,但 Gazebo 世界坐标实际位移明显更小 |
轮地摩擦、接触参数、轮半径或轮速里程计高估;疑似打滑 |
如果 /odom 由轮速积分产生,它可能与命令接近却无法反映真实打滑。以连续 2 秒、0.20 m/s 为例,理想位移为 0.40 m;若轮速里程计仍报告约 0.40 m,而 Gazebo 世界位姿只前进 0.26 m,应沿物理接触与里程计标定方向调查。RViz 中由相同 /odom 和 TF 绘制的轨迹不能充当独立真值。
检查配置并完成复测
先读取当前配置,不要同时修改多个限速节点:
ros2 param get /controller_server controller_frequency
ros2 param get /controller_server odom_topic
ros2 param get /velocity_smoother smoothing_frequency
ros2 param get /velocity_smoother max_velocity
ros2 param get /velocity_smoother max_accel
ros2 param get /velocity_smoother feedback预期结果:返回各节点当前的 Double value、String value 或 Double array value;若节点不存在,应先核对 ros2 node list 和实际命名空间。DWB 还要看 FollowPath.max_vel_x,RPP 看 FollowPath.desired_linear_vel,MPPI 看 FollowPath.vx_max(以实际加载的插件为准)。
里程计帧率不稳定时,核对 /odom 消息中的 header.stamp 是否随仿真时钟递增,以及 use_sim_time、Gazebo 发布周期和 ROS–Gazebo 桥接是否一致;Twist 命令没有消息头,不能把接收时间误当发送时间。若启用平滑器 feedback: CLOSED_LOOP,低频或高延迟里程计尤其容易影响其速度估计。
每次只修正一类问题,重复同一路段 3 次:检查稳态速度差是否缩小、/odom 是否持续更新、Gazebo 真实轨迹与里程计累计位移是否接近。只有三者一致时,才继续调局部控制器的路径跟踪参数。