ROS运行roslaunch时dwa_planner进程异常退出问题求助

核心原因分析 #

exit code -8 对应浮点运算异常（如除以零、NaN/Inf值扩散），结合你定位到ros::spinOnce()至loop_rate.sleep()的崩溃点，问题大概率出在规划逻辑的数值计算环节，而非话题映射或初始化。

分步排查与修复 #

• 校验传感器与地图数据有效性
  运行时通过命令实时检查数据：

  rostopic echo /local_map --noarr
  rostopic echo /scan_2 | grep "ranges"
  

  重点确认：局部地图是否存在尺寸为0的情况；激光扫描数据是否包含NaN/Inf值，或扫描范围出现异常。
• 添加关键计算节点的日志与校验
  在原代码的核心计算模块（轨迹生成、评分、运动学转换）中，对变量添加合法性检查：

  // 示例：轨迹评分时避免除以零
  double dist_to_obstacle = getObstacleDistance(trajectory);
  if (dist_to_obstacle < 0.01) {
    ROS_WARN_THROTTLE(1, "Obstacle distance too small, skip this trajectory");
    continue;
  }
  double score = 1.0 / dist_to_obstacle;
  

• 调整消息订阅与循环速率
  若消息堆积导致数据处理不及时，修改订阅者的队列大小：

  ros::Subscriber map_sub = nh.subscribe("/local_map", 5, &DWAPlanner::mapCallback, this);
  

  同时确认loop_rate的设置与硬件算力匹配，避免因CPU过载引发异常。
• 检测内存问题
  使用valgrind工具排查内存泄漏或非法内存访问：

  valgrind --leak-check=full ./devel/lib/dwa_planner/dwa_planner /cmd_vel:=/cmd_vel_1 [其他参数]
  

针对原仓库代码的针对性修复 #

原仓库的DWA实现未做严格数值防护，建议重点修改两处：

1. 在generateTrajectories函数中，对采样的线速度、角速度添加边界校验，避免超出机器人运动极限
2. 在evaluateTrajectory函数中，对障碍物距离、目标点距离的倒数计算添加非零判断，防止浮点错误

内容的提问来源于stack exchange，提问作者刘腾飞