### ROS `ros::ServiceServer` 的使用方法及示例 #### 1. 定义服务消息 在 ROS 中，`ros::ServiceServer` 是用于创建服务端的核心类之一。它允许节点提供某种功能供其他节点请求。要实现一个服务端程序，首先需要定义服务的消息类型 `.srv` 文件。 例如，在包目录下创建一个名为 `TwoInts.srv` 的文件[^3]： ``` int64 a int64 b --- int64 sum ``` 该文件表示服务接收两个整数作为输入 (`a`, `b`)，并返回它们的和 (`sum`)。 --- #### 2. 编写 C++ 实现代码 以下是基于上述服务定义的一个完整的服务端实现代码[^3]: ```cpp #include <ros/ros.h> #include <roscpp_tutorials/TwoInts.h> // 定义回调函数 bool callback(roscpp_tutorials::TwoInts::Request &request, roscpp_tutorials::TwoInts::Response &response) { response.sum = request.a + request.b; ROS_INFO_STREAM("Request received: " << request.a << " + " << request.b); return true; } int main(int argc, char **argv) { // 初始化 ROS 节点 ros::init(argc, argv, "service_server"); // 创建 NodeHandle 对象 ros::NodeHandle nh; // 注册服务 ros::ServiceServer server = nh.advertiseService("add_two_ints", callback); ROS_INFO("Ready to add two ints."); // 进入自旋等待服务请求 ros::spin(); return 0; } ``` --- #### 3. 关键说明 - **`advertiseService()` 函数**: 此函数用于注册服务，并指定其对应的回调函数。语法如下： ```cpp ros::ServiceServer advertiseService(const std::string& service_name, bool (*callback)(const MReq&, MRes&), const VoidConstPtr&) ``` - **回调函数签名**: 回调函数需接受两个参数：一个是请求对象 (继承自 `MReq`)，另一个是响应对象 (继承自 `MRes`)。通过修改响应对象来向客户端传递数据[^3]。 - **日志记录**: 使用 `ROS_INFO_STREAM` 或其他类似的宏可以方便调试和服务监控。 --- #### 4. Python 实现示例 除了 C++ 外，也可以用 Python 来编写服务端程序[^3]： ```python #!/usr/bin/env python import rospy from roscpp_tutorials.srv import TwoInts, TwoIntsResponse def callback(request): response = TwoIntsResponse() response.sum = request.a + request.b rospy.loginfo(f"Received Request: {request.a} + {request.b}") return response if __name__ == "__main__": rospy.init_node('service_server') service = rospy.Service('add_two_ints', TwoInts, callback) rospy.loginfo("Ready to add two integers.") rospy.spin() ``` --- #### 5. 启动与测试 完成以上步骤后，可以通过以下命令编译和运行服务端程序： ```bash catkin_make source devel/setup.bash rosrun your_package_name service_server_node ``` 接着，可使用 `rosservice call` 测试服务的功能： ```bash rosservice call /add_two_ints "{a: 5, b: 7}" ``` 这将触发回调函数计算两数之和，并打印结果到终端。 --- #### 6. 扩展阅读 如果希望进一步了解如何与其他编程语言交互（如 Java），可以参考 ROSSBridge 工具的相关文档[^2]。ROSSBridge 提供了一种轻量级的方式让 Android 应用或其他平台能够访问 ROS 服务。 ---