# MoveIt2 servo_node初始化等待状态时SIGINT无法退出

> 原文链接：https://robotics.hellobike.com/pitfalls/2026-11-07-moveit2-3536
> 频道：pitfalls | 更新日期：2026-11-07 | 标签：auto, github-issue, moveit2
> 核心摘要：servo_node在等待机器人状态更新时忽略SIGINT导致挂起，需在等待循环中增加rclcpp::ok()与stop_servo_检查。

# MoveIt2 servo_node初始化等待状态时SIGINT无法退出

::: v-pre
> 本文由 AI 根据公开内容整理，可能有误，请以原文为准：[servo_node does not shut down on SIGINT if initializing](https://github.com/moveit/moveit2/issues/3536)（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

## 解决办法

1. 修改`servo_node.cpp`中`ServoNode::servoLoop()`起始处的等待循环，将条件改为同时检查`rclcpp::ok() && !stop_servo_`，若任一条件为假则立即返回以响应停止信号。
2. 删除该等待循环后残留的日志打印与1秒睡眠代码块（疑似#3529遗留），避免阻塞退出流程。
3. 添加单元测试：创建无机器人状态发布的`ServoNode`实例，验证销毁操作能在短超时内正常返回，确保修复有效。

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

## 原始参考来源 (Sources)

- [GitHub ros-planning/moveit2 #3536：servo_node does not shut down on SIGINT if initializing](https://github.com/moveit/moveit2/issues/3536)