基于C++构建ROS2动作通信的完整生命周期

在现代机器人系统中，复杂的异步任务交互是核心需求之一。无论是机械臂的轨迹规划、移动机器人的自主导航，还是多机器人协同作业，都需要一种可靠、高效的通信机制来处理长时间运行的任务。ROS2动作（Action）正是为此而设计的强大通信模式，它结合了话题的发布订阅机制和服务的请求响应模式，同时提供了任务取消和进度反馈等关键功能。

对于中高级ROS2开发者而言，深入理解动作通信的完整生命周期至关重要。本文将带你从动作定义开始，逐步构建健壮的动作服务器和客户端，探讨异常处理、取消机制和反馈系统的实现细节，最终形成一个能够处理复杂机器人任务的完整通信框架。

1. 动作通信基础与设计原理

ROS2动作是一种基于请求-响应模式的异步通信机制，专门设计用于处理执行时间较长的任务。与服务（Service）不同，动作允许任务执行过程中断和取消，同时提供定期反馈机制，让客户端能够了解任务进度。

每个动作由三个部分组成：目标（Goal）、反馈（Feedback）和结果（Result）。这种结构使得动作非常适合需要持续监控的任务，如导航到指定位置、物体抓取、复杂计算等。动作通信建立在ROS2底层通信系统之上，使用动作定义文件（.action）来定义接口规范。

动作生命周期状态机包含以下几个关键状态：

待处理：目标已接收但尚未开始执行
执行中：任务正在执行，可发送反馈
取消中：取消请求已接收，正在处理
成功：任务顺利完成
取消：任务被成功取消
中止：任务因错误而终止

理解这些状态及其转换是构建可靠动作通信系统的基础。在实际实现中，我们需要确保每个状态转换都能正确处理，并提供适当的反馈信息。

2. 环境准备与工程配置

开始构建动作服务器和客户端之前，需要确保开发环境正确配置。以下是基于Ubuntu和ROS2 Jazzy的环境要求：

# 安装ROS2基础环境
sudo apt install ros-jazzy-desktop
# 创建工作空间并初始化
mkdir -p ~/ros2_ws/src
cd ~/ros2_ws/src
# 创建功能包（已存在自定义动作接口的前提下）
ros2 pkg create --dependencies custom_action_interfaces rclcpp rclcpp_action rclcpp_components --build-type ament_cmake --license Apache-2.0 custom_action_cpp

在CMakeLists.txt中，我们需要正确配置编译选项和依赖关系。以下是关键配置部分：

# 添加动作服务器编译目标
add_library(action_server SHARED src/fibonacci_action_server.cpp)
# 设置包含目录
target_include_directories(action_server PRIVATE $<BUILD_INTERFACE:${CMAKE_CURRENT_SOURCE_DIR}/include> $<INSTALL_INTERFACE:include>)
# 添加编译定义（Windows兼容性）
target_compile_definitions(action_server PRIVATE "CUSTOM_ACTION_CUSTOM_ACTION_CPP_BUILDING_DLL")
# 声明依赖项
ament_target_dependencies(action_server "custom_action_interfaces" "rclcpp" "rclcpp_action" "rclcpp_components")
# 注册节点组件
rclcpp_components_register_node(action_server PLUGIN "custom_action_cpp::FibonacciActionServer" EXECUTABLE fibonacci_action_server)

对于跨平台开发，还需要处理符号可见性控制。创建 include/custom_action_cpp/visibility_control.h 文件：

#ifndef CUSTOM_ACTION_CPP__VISIBILITY_CONTROL_H_
#define CUSTOM_ACTION_CPP__VISIBILITY_CONTROL_H_
#ifdef __cplusplus
extern "C" {
#endif
// 基于编译器平台的可见性控制宏
#if defined _WIN32 || defined __CYGWIN__
#ifdef __GNUC__
#define CUSTOM_ACTION_CPP_EXPORT __attribute__ ((dllexport))
#define CUSTOM_ACTION_CPP_IMPORT __attribute__ ((dllimport))
#else
#define CUSTOM_ACTION_CPP_EXPORT __declspec(dllexport)
#define CUSTOM_ACTION_CPP_IMPORT __declspec(dllimport)
#endif
#ifdef CUSTOM_ACTION_CPP_BUILDING_DLL
#define CUSTOM_ACTION_CPP_PUBLIC CUSTOM_ACTION_CPP_EXPORT
#else
#define CUSTOM_ACTION_CPP_PUBLIC CUSTOM_ACTION_CPP_IMPORT
#endif
#else
#define CUSTOM_ACTION_CPP_EXPORT __attribute__ ((visibility("default")))
#define CUSTOM_ACTION_CPP_IMPORT
#if __GNUC__ >= 4
#define CUSTOM_ACTION_CPP_PUBLIC __attribute__ ((visibility("default")))
#define CUSTOM_ACTION_CPP_LOCAL __attribute__ ((visibility("hidden")))
#else
#define CUSTOM_ACTION_CPP_PUBLIC
#define CUSTOM_ACTION_CPP_LOCAL
#endif
#endif
#ifdef __cplusplus
}
#endif
#endif // CUSTOM_ACTION_CPP__VISIBILITY_CONTROL_H_

提示：良好的工程配置是项目成功的基础，特别是在跨平台开发时。确保所有依赖项正确声明，可见性控制适当配置，可以避免许多难以调试的运行时错误。

3. 动作服务器实现详解

动作服务器是实现机器人任务逻辑的核心组件。它负责接收客户端的目标请求，执行具体任务，定期发送进度反馈，并在任务完成后返回最终结果。

3.1 服务器架构与初始化

首先创建 FibonacciActionServer 类，继承自 rclcpp::Node：

#include <functional>
#include <memory>
#include <thread>
#include "custom_action_interfaces/action/fibonacci.hpp"
#include "rclcpp/rclcpp.hpp"
#include "rclcpp_action/rclcpp_action.hpp"
#include "rclcpp_components/register_node_macro.hpp"
#include "custom_action_cpp/visibility_control.h"
namespace custom_action_cpp