机器人 / 系统课时

约束线速度、角速度与加速度

约束线速度、角速度与加速度

机器人能正确规划路径,却在起步时突冲、拐弯时转得太急或停车时拖尾,就要同时检查局部控制器与速度平滑器的限值。下面以 ROS 2 Jazzy 的差速仿真为例,将前进速度限制在 0.20 m/s、角速度限制在 1.0 rad/s,并观察加减速是否符合预期。

学习目标

  • 找到当前控制器插件,区分线速度、角速度和加减速度的参数。
  • 调整 MPPI 与 Velocity Smoother 的一致限值,避免指令跳变。
  • 对照速度指令与 /odom,验收起步、转弯和停止三个阶段。

确认控制器和话题链路

先在已经启动 Nav2 的终端查询正在使用的插件。Jazzy 官方 nav2_bringup 示例参数使用 MPPI,但 TurtleBot3 或自定义启动文件可能选择 DWB、RPP;不同插件的字段不能混用。

bash
ros2 param get /controller_server FollowPath.plugin

预期输出(采用本篇 MPPI 配置时):

text
String value is: nav2_mppi_controller::MPPIController

在使用标准导航启动映射且启用速度平滑器和碰撞监控时,控制器发往 /cmd_vel_nav,Velocity Smoother 从此读取并发往 /cmd_vel_smoothed,Collision Monitor 再处理后输出 /cmd_vel。自定义启动时应通过 ros2 topic list -t 核对实际话题,不要直接把未经确认的控制器输出当作底盘执行指令。

设置速度和加速度上限

先按一个保守的仿真目标配置:只前进、不倒车;允许左右原地旋转;线速度范围为 0~0.20 m/s,角速度范围为 -1.0~1.0 rad/s。线加速度和制动减速度幅值均为 0.50 m/s²,角加速度和角减速度幅值均为 1.50 rad/s²。

下面是片段示例:在当前启动命令实际加载的 nav2_params.yaml 里,分别合并到已有的 controller_server.ros__parameters 与 velocity_smoother.ros__parameters,不要追加重复节点,也不要删除原有的 MPPI critics、motion_model、代价地图及其他配置。

yaml
controller_server:
  ros__parameters:
    controller_frequency: 20.0
    enable_stamped_cmd_vel: false  # Jazzy 示例使用 Twist
    FollowPath:
      plugin: "nav2_mppi_controller::MPPIController"
      vx_max: 0.20
      vx_min: 0.0
      wz_max: 1.0
      ax_max: 0.50
      ax_min: -0.50
      az_max: 1.50

velocity_smoother:
  ros__parameters:
    smoothing_frequency: 50.0
    feedback: "OPEN_LOOP"
    enable_stamped_cmd_vel: false
    # 三轴依次为 x、y、theta,差速底盘的 y 分量为 0
    max_velocity: [0.20, 0.0, 1.0]
    min_velocity: [0.0, 0.0, -1.0]
    max_accel: [0.50, 0.0, 1.50]
    max_decel: [-0.50, 0.0, -1.50]

配置生效行为:MPPI 限制候选控制量,平滑器按 [x, y, theta] 三轴限制最终速度变化。vx_min: 0.0 禁止后退;旋转允许负号方向由平滑器的 min_velocity[2] 指定。ax_min、max_decel 都应为负值。合并后用原来的启动方式重新加载这份参数文件并重启 Nav2,而不是只修改磁盘文件。

理解起停和转弯的速度曲线

控制器按 20 Hz 计算,即约每 0.05 s 更新一次;平滑器设为 50 Hz,每 0.02 s 最多提高 0.01 m/s 线速度或改变 0.03 rad/s 角速度。若上游持续要求从静止达到 0.20 m/s,仅按 0.50 m/s² 加速限制估算,至少约需 0.40 s;由 0.20 m/s 减速到零也约需 0.40 s。真实到达时间还取决于路径、避障和底盘反馈。

起步、转弯和停车阶段的线速度与角速度限幅曲线

转弯时线速度是否下降,由 MPPI 对路径、障碍与代价的优化决定;分别设置 vx_max 和 wz_max 不等于自动规定“越急的弯越慢”。本例角速度和线速度都要满足各自限幅,拐弯时还需核对机器人是否偏离全局路径。

运行并检查实际速度

保持空旷仿真场景,在 RViz 依次发送一段约 1 m 的直线目标、需要约 90° 改向的目标以及近距离停车目标。先确认重启后的参数确实已加载:

bash
ros2 param get /controller_server FollowPath.vx_max
ros2 param get /velocity_smoother smoothing_frequency

预期输出:

text
Double value is: 0.2
Double value is: 50.0

导航执行期间,在一个终端观察平滑后的线速度:

bash
ros2 topic echo /cmd_vel_smoothed --field linear.x

预期结果:持续输出数值与分隔符 ---,线速度不超过 0.20 m/s,起停段逐步增减;具体值取决于目标与障碍,按 Ctrl+C 结束。另开终端执行 ros2 topic echo /cmd_vel_smoothed --field angular.z 检查转弯期间角速度幅值不超过 1.0 rad/s;再用 ros2 topic echo /odom --field twist.twist.linear.x 检查仿真实际速度是否跟随指令,允许存在动态滞后。

发现限速无效时怎样定位

观察到的现象 优先检查与修正
FollowPath.vx_max 无法读取或数值没变 再查 FollowPath.plugin;确认加载的是编辑过的参数文件,重启生命周期节点。
/cmd_vel_smoothed 不存在 用 ros2 topic list -t 核对话题重映射、velocity_smoother 是否启动且处于 active。
拐弯角速度过大 核对 wz_max、平滑器角速度上下界;检查是否另有恢复行为或遥控节点在发速度。
停车迟缓或拐弯跟不上 比较 /cmd_vel_smoothed 与 /odom;评估 0.50 m/s² 制动约束是否过小,并结合障碍距离调整。

如果正在使用 DWB,应调整 max_vel_x、min_vel_x、max_speed_xy、max_vel_theta、acc_lim_x、decel_lim_x、acc_lim_theta、decel_lim_theta,而不是 MPPI 的 vx_max 等字段;RPP 则用 desired_linear_vel 等参数配合 Velocity Smoother。Jazzy 中 enable_stamped_cmd_vel: false 对应 geometry_msgs/msg/Twist,若改成 true,整条链路的消息类型也必须一致。任何软件限幅都不能代替底盘固有限速与硬件急停。

按自己的节奏,确认真正理解。

目录与阅读设置

阅读设置

17

记录一个想法

约束线速度、角速度与加速度

0 / 10000 · 笔记保存到账号。未提交的修改会在关闭、离开或刷新后丢失。

登录哪都通