踩坑GitHub ros-navigation/navigation2今天

Smac Planner阿克曼车辆频繁换向问题及方向切换惩罚调优

针对Smac Planner缺乏前进/后退切换惩罚导致路径频繁换向，维护者建议将方向切换代价设为极高值以强制减少换向次数。

AI 整理

感知与导航

本文由 AI 根据公开内容整理，可能有误，请以原文为准：Gear Change Penalty to the Smac Planner（GitHub ros-navigation/navigation2 #6195）

状态：有绕过办法

问题

在ROS2 Jazzy环境下使用Smac Planner规划阿克曼转向车辆路径时，现有cost function仅包含左右运动原语切换惩罚，缺少前进与后退段（FORWARD <=> REVERSE）切换惩罚。这导致规划器生成包含频繁短距离倒车尖点的路径，而非更平滑的长距离倒车路径，影响车辆运动性能。

环境

ROS2 Jazzy, Ubuntu 22.04, navigation2 Smac Planner, 阿克曼转向机器人（car-like robot）

解决办法

在Smac Planner配置中将方向切换代价（change direction cost）设置为极高值，通过增大惩罚权重迫使规划器将方向切换次数降至绝对最小，从而偏好更少换向的路径。
接受因高惩罚权重导致的搜索时间延长作为获取理想路径质量的必要权衡。
关注并测试官方PR #6734，该补丁实现了专门的方向切换惩罚功能，可作为长期集成方案替代手动调参。
注意当前版本不支持Reeds-Shepp搜索配合Dubins解析扩展（analytical shot）的混合模式，相关功能仍在Issue #6075讨论中尚无原型。

讨论原作者：@jgoudge 等，版权归原作者所有。