創建功能包

cd ~/catkin_ws/src catkin_create_pkg learning_communication roscpp rospy std_msgs geometry_msgs turtlesim

定義 srv 文件

cd ~/catkin_ws/src/learning_communication mkdir srv

創建 AddTwoInts.srv 文件

cd ~/catkin_ws/src/learning_communication/srv touch AddTwoInts.srv

AddTwoInts.srv 文件內容

int64 a int64 b --- int64 sum

在package.xml中添加功能包依賴

<build_depend>message_generation</build_depend> <exec_depend>message_runtime</exec_depend>

在CMakeLists.txt添加編譯選項

find_package(catkin REQUIRED COMPONENTS............message_generation )

catkin_package( # INCLUDE_DIRS include # LIBRARIES learning_topicCATKIN_DEPENDS geometry_msgs roscpp rospy std_msgs turtlesim message_runtime # DEPENDS system_lib )

add_service_files(FILES AddTwoInts.srv) generate_messages(DEPENDENCIES std_msgs)

配置完成后，對工程目錄進行編譯

cd ~/catkin_ws catkin_make

通過以下代碼去調用生成的頭文件

在 src 目錄下創建 兩個 cpp文件

cd ~/catkin_ws/src/learning_communication/src

創建 server.cpp 文件

touch server.cpp

以下是server.cpp 文件中的內容
代碼功能：將輸入參數中的請求數據相加，結果放到應答變量中

#include <ros/ros.h> #include "learning_communication/AddTwoInts.h"// service回調函數，輸入參數req，輸出參數res bool add(learning_communication::AddTwoInts::Request &req,learning_communication::AddTwoInts::Response &res) {// 將輸入參數中的請求數據相加，結果放到應答變量中res.sum = req.a + req.b;ROS_INFO("request: x=%ld, y=%ld", (long int)req.a, (long int)req.b);ROS_INFO("sending back response: [%ld]", (long int)res.sum);return true; }int main(int argc, char **argv) {// ROS節點初始化ros::init(argc, argv, "add_two_ints_server");// 創建節點句柄ros::NodeHandle n;// 創建一個名為/show_person的server，注冊回調函數personCallbackros::ServiceServer service = n.advertiseService("/add_two_ints", add);// 循環等待回調函數ROS_INFO("Ready to add two ints.");ros::spin();return 0; }

創建 client.cpp 文件

touch client.cpp

client.cpp 文件中的內容
代碼功能：發布service請求，等待加法運算的應答結果

#include <cstdlib> #include <ros/ros.h> #include "learning_communication/AddTwoInts.h"int main(int argc, char** argv) {// 初始化ROS節點ros::init(argc, argv, "add_two_ints_client");// 從終端命令行獲取兩個加數if (argc != 3){ROS_INFO("usage: add_two_ints_client X Y");return 1;}// 創建節點句柄ros::NodeHandle n;// 創建一個client，請求add_two_int service, service消息類型是 learning_communication::AddTwoIntsros::ServiceClient client = n.serviceClient<learning_communication::AddTwoInts>("add_two_ints");// 創建learning_communication::AddTwoInts類型的service消息learning_communication::AddTwoInts srv;srv.request.a = atoll(argv[1]);srv.request.b = atoll(argv[2]);// 發布service請求，等待加法運算的應答結果if (client.call(srv)){ROS_INFO("Sum: %ld", (long int)srv.response.sum);}else{ROS_ERROR("Failed to call service add_two_ints");return 1;}return 0; };

在CMakeLists.txt文件中添加以下代碼：

add_executable(server src/server.cpp) target_link_libraries(server ${catkin_LIBRARIES}) add_dependencies(server ${PROJECT_NAME}_gencpp)add_executable(client src/client.cpp) target_link_libraries(client ${catkin_LIBRARIES}) add_dependencies(client ${PROJECT_NAME}_gencpp)

編譯工程項目

cd ~/catkin_ws catkin_make

啟動ROS Master

roscore

啟動自定義的訂閱者節點

rosrun learning_communication server

啟動自定義的發布者節點

rosrun learning_communication client 7 8

Client啟動后發布服務請求，并成功接收到反饋結果。

Server接收到服務調用后完成加法求解，并將結果反饋給Client。

總結

以上是生活随笔為你收集整理的ROS系统 通过服务编程实现两个数相加并返回的全部內容，希望文章能夠幫你解決所遇到的問題。

如果覺得生活随笔網站內容還不錯，歡迎將生活随笔推薦給好友。