踩坑GitHub ros-planning/moveit214 天前
MoveIt2 servo_node初始化等待状态时SIGINT无法退出
本文由 AI 根据公开内容整理,可能有误,请以原文为准:servo_node does not shut down on SIGINT if initializing(GitHub ros-planning/moveit2 #3536)
状态:有绕过办法
问题
MoveIt2的servo_node在未收到机器人状态更新(如上游未启动)时进入等待循环,此时发送Ctrl-C/SIGINT信号节点无法正常关闭,仅持续每秒打印“Waiting to receive robot state update”日志。即使触发signal_handler,进程仍挂起不退出。
环境
ROS Jazzy, Ubuntu 24.04, MoveIt2 2.12.3-1noble.20250624.030954 (Binary), servo_node
解决办法
- 修改
servo_node.cpp中ServoNode::servoLoop()起始处的等待循环,将条件改为同时检查rclcpp::ok() && !stop_servo_,若任一条件为假则立即返回以响应停止信号。 - 删除该等待循环后残留的日志打印与1秒睡眠代码块(疑似#3529遗留),避免阻塞退出流程。
- 添加单元测试:创建无机器人状态发布的
ServoNode实例,验证销毁操作能在短超时内正常返回,确保修复有效。
讨论原作者:@mrjogo 等,版权归原作者所有。
外部来源
本页事实对应的公开页面,以原文为准。(点击将离开本站)