ROS2接口实战：从零构建自定义msg与srv并集成到C++/Python节点

1. 为什么需要自定义ROS2接口

在机器人开发中，预定义的ROS2标准接口就像乐高积木的基础模块，能满足大部分常规需求。但当你需要开发特殊传感器驱动或定制控制协议时，这些标准接口往往不够用。比如我们团队曾为工业机械臂开发视觉引导系统，标准几何消息类型无法承载我们需要的3D点云特征数据，这时候自定义接口就成了刚需。

自定义msg/srv的核心价值在于三点：首先是数据表达的精确性，比如我们的机械臂需要毫米级精度的关节角度，用float64比标准float32更合适；其次是业务语义的明确性，给字段命名如end_effector_pose比通用的PoseStamped更易理解；最后是系统解耦，接口变更不会影响上下游节点实现。

2. 创建自定义接口包

2.1 准备工作环境

我推荐使用Ubuntu 22.04 + ROS2 Humble组合，这个LTS版本有5年维护期。实测在WSL2中也能流畅运行，但要注意Windows和Linux的换行符差异可能导致编译错误。创建工作空间的命令还是经典的：

mkdir -p ~/dev_ws/src cd ~/dev_ws/src

2.2 创建接口专用包

关键点在于必须选择ament_cmake构建类型，这是目前唯一支持接口生成的包类型。执行以下命令创建包：

ros2 pkg create --build-type ament_cmake robot_control_interfaces

建议包名带_interfaces后缀，这是ROS社区的约定俗成。接着建立消息和服务目录：

cd robot_control_interfaces mkdir msg srv

3. 定义消息与服务

3.1 设计消息文件

在msg/JointState.msg中定义机械臂关节状态：

float64[6] positions # 6个关节角度(弧度) float64[6] velocities # 关节角速度 float64[6] efforts # 关节力矩 string controller_id # 控制器标识

这个设计比标准JointState多了控制器ID字段，方便多控制器场景下的数据溯源。数组长度固定为6是因为我们的机械臂有6个自由度。

3.2 设计服务文件

在srv/ExecuteTrajectory.srv中定义轨迹执行服务：

# 请求参数 JointState[] waypoints # 路径点数组 float64 speed_factor # 速度系数(0.1~1.0) --- # 响应结果 bool success string error_message

这里用到了前面定义的JointState消息作为数组元素，展示了接口的组合能力。speed_factor参数让客户端可以动态调整运动速度。

4. 配置构建系统

4.1 CMakeLists.txt关键配置

在CMakeLists.txt中添加：

find_package(rosidl_default_generators REQUIRED) rosidl_generate_interfaces(${PROJECT_NAME} "msg/JointState.msg" "srv/ExecuteTrajectory.srv" DEPENDENCIES builtin_interfaces )

注意当消息中包含标准类型(如std_msgs/Header)时，需要在DEPENDENCIES中声明依赖。

4.2 package.xml依赖配置

需要添加以下依赖项：

<build_depend>rosidl_default_generators</build_depend> <exec_depend>rosidl_default_runtime</exec_depend> <member_of_group>rosidl_interface_packages</member_of_group>

如果消息中使用了其他接口包的类型，还需要添加对应依赖，例如：

<depend>geometry_msgs</depend>

5. 编译与验证

5.1 编译接口包

使用以下命令编译：

colcon build --packages-select robot_control_interfaces

编译成功后，在install目录下会生成Python模块和C++头文件。我习惯用tree命令检查输出结构：

tree install/robot_control_interfaces

5.2 接口功能测试

验证消息定义是否正确：

ros2 interface show robot_control_interfaces/msg/JointState

应该看到完整的字段定义。服务验证同理：

ros2 interface show robot_control_interfaces/srv/ExecuteTrajectory

6. C++节点集成实战

6.1 创建控制节点包

新建一个C++功能包：

ros2 pkg create --build-type ament_cmake arm_controller \ --dependencies rclcpp robot_control_interfaces

6.2 编写轨迹执行服务端

在src/trajectory_server.cpp中：

#include "rclcpp/rclcpp.hpp" #include "robot_control_interfaces/srv/execute_trajectory.hpp" class TrajectoryServer : public rclcpp::Node { public: TrajectoryServer() : Node("trajectory_server") { service_ = create_service<robot_control_interfaces::srv::ExecuteTrajectory>( "execute_trajectory", [this](const auto &request, auto &response) { // 轨迹执行逻辑 for (const auto &point : request->waypoints) { RCLCPP_INFO(this->get_logger(), "Moving to position: %f", point.positions[0]); } response->success = true; }); } private: rclcpp::Service<robot_control_interfaces::srv::ExecuteTrajectory>::SharedPtr service_; };

6.3 配置节点编译

在CMakeLists.txt中添加：

add_executable(trajectory_server src/trajectory_server.cpp) ament_target_dependencies(trajectory_server rclcpp robot_control_interfaces) install(TARGETS trajectory_server DESTINATION lib/${PROJECT_NAME})

7. Python节点集成实战

7.1 创建Python节点包

ros2 pkg create --build-type ament_python arm_control_py \ --dependencies rclpy robot_control_interfaces

7.2 编写状态发布节点

在arm_control_py/arm_control_py/joint_publisher.py中：

import rclpy from rclpy.node import Node from robot_control_interfaces.msg import JointState class JointPublisher(Node): def __init__(self): super().__init__('joint_publisher') self.publisher = self.create_publisher( JointState, 'joint_states', 10) timer_period = 0.1 # 10Hz self.timer = self.create_timer( timer_period, self.timer_callback) self.joint_positions = [0.0] * 6 def timer_callback(self): msg = JointState() msg.positions = self.joint_positions msg.velocities = [0.0] * 6 msg.efforts = [0.0] * 6 msg.controller_id = "main_controller" self.publisher.publish(msg)

7.3 配置Python包

在setup.py中确保正确声明入口点：

entry_points={ 'console_scripts': [ 'joint_publisher = arm_control_py.joint_publisher:main', ], }

8. 跨语言通信验证

8.1 启动C++服务节点

ros2 run arm_controller trajectory_server

8.2 启动Python发布节点

ros2 run arm_control_py joint_publisher

8.3 测试通信

新建终端调用服务：

ros2 service call /execute_trajectory robot_control_interfaces/srv/ExecuteTrajectory \ "{waypoints: [{positions: [0.1,0.2,0.3,0.4,0.5,0.6], velocities: [0,0,0,0,0,0], efforts: [0,0,0,0,0,0], controller_id: 'test'}], speed_factor: 0.5}"

同时可以用ros2 topic echo /joint_states查看发布的消息。我在实际项目中遇到过Python节点收不到C++服务的问题，最后发现是CMakeLists.txt漏了接口依赖声明。这种跨语言调试的关键是确保两边接口的MD5校验一致。