Robot Operating System——自定义Service/Client通信消息结构

2024-08-24 10:36
文章标签 自定义 通信 robot 结构 消息 system client service operating

本文主要是介绍Robot Operating System——自定义Service/Client通信消息结构，希望对大家解决编程问题提供一定的参考价值，需要的开发者们随着小编来一起学习吧！

大纲

  • 初始化环境
  • 生成自定义服务的工程
    • 创建包
    • 自定义消息
    • package.xml
      • 完整文件
    • CMakeLists.txt
      • 完整文件
    • 编译
    • 注册
  • 使用自定义服务的工程
    • 创建包
    • 代码
    • CMakeLists.txt
    • 编译
    • 运行
  • 工程地址
  • 参考资料

在《Robot Operating System——自定义订阅/发布的消息结构》一文中，我们讲解了如何自定义消息结构。这个消息是发布者向订阅者发送的消息，具有单向性。但是Service/Client类型的消息是具有双向性的。Client向Service发送的是Request消息，Service向Client发送的是Response消息。

初始化环境

在《Robot Operating System——深度解析自动隐式加载动态库的运行模式》一文中，我们展现了ROS2可执行文件的链接指令。可以看到它依赖了很多ROS2环境相关的动态库，所以我们在创建工程之前也要初始化环境。

source /opt/ros/jazzy/setup.bash

关于环境的安装可以参见《Robot Operating System——Ubuntu上以二进制形式安装环境》。

生成自定义服务的工程

创建包

ros2 pkg create --build-type ament_cmake --license Apache-2.0 custom_service

在这里插入图片描述
其目录结构如下
在这里插入图片描述

自定义消息

我们创建一个目录srv，然后在其下新建一个文件NavSatPose.srv，填入下面的内容

sensor_msgs/NavSatStatus nav
---
geometry_msgs/PoseWithCovariance pose
std_msgs/Bool boolvalue

nav是Request消息结构体中的内容；pose和boolvalue是Response消息结构体中的内容。
在这里插入图片描述

package.xml

在该文件中新增如下内容

  <depend>sensor_msgs</depend><depend>geometry_msgs</depend><depend>std_msgs</depend><buildtool_depend>rosidl_default_generators</buildtool_depend><exec_depend>rosidl_default_runtime</exec_depend><member_of_group>rosidl_interface_packages</member_of_group>

sensor_msgs、geometry_msgs和std_msgs是消息体中用的三种ROS2提供的基础消息类型；
rosidl_default_generators用于将上述msg文件生成代码；
rosidl_default_runtime是运行时依赖；
后三者是一定要加的，前面的三个根据自定义消息的类型酌情添加。
此时的目录结构如下

完整文件

<?xml version="1.0"?>
<?xml-model href="http://download.ros.org/schema/package_format3.xsd" schematypens="http://www.w3.org/2001/XMLSchema"?>
<package format="3"><name>custom_service</name><version>0.0.0</version><description>TODO: Package description</description><maintainer email="f304646673@gmail.com">fangliang</maintainer><license>Apache-2.0</license><buildtool_depend>ament_cmake</buildtool_depend><depend>sensor_msgs</depend><depend>geometry_msgs</depend><depend>std_msgs</depend><buildtool_depend>rosidl_default_generators</buildtool_depend><exec_depend>rosidl_default_runtime</exec_depend><member_of_group>rosidl_interface_packages</member_of_group><test_depend>ament_lint_auto</test_depend><test_depend>ament_lint_common</test_depend><export><build_type>ament_cmake</build_type></export>
</package>

CMakeLists.txt

新增如下内容

find_package(sensor_msgs REQUIRED)
find_package(geometry_msgs REQUIRED)
find_package(std_msgs REQUIRED)
find_package(rosidl_default_generators REQUIRED)rosidl_generate_interfaces(${PROJECT_NAME}"srv/NavSatPoseBool.srv"DEPENDENCIES sensor_msgs geometry_msgs std_msgs 
)

DEPENDENCIES 中添加的是我们自定义消息的基础类型。

完整文件

cmake_minimum_required(VERSION 3.8)
project(custom_service)if(CMAKE_COMPILER_IS_GNUCXX OR CMAKE_CXX_COMPILER_ID MATCHES "Clang")add_compile_options(-Wall -Wextra -Wpedantic)
endif()# find dependencies
find_package(ament_cmake REQUIRED)
# uncomment the following section in order to fill in
# further dependencies manually.
# find_package(<dependency> REQUIRED)find_package(sensor_msgs REQUIRED)
find_package(geometry_msgs REQUIRED)
find_package(std_msgs REQUIRED)
find_package(rosidl_default_generators REQUIRED)rosidl_generate_interfaces(${PROJECT_NAME}"srv/NavSatPoseBool.srv"DEPENDENCIES sensor_msgs geometry_msgs std_msgs 
)if(BUILD_TESTING)find_package(ament_lint_auto REQUIRED)# the following line skips the linter which checks for copyrights# comment the line when a copyright and license is added to all source filesset(ament_cmake_copyright_FOUND TRUE)# the following line skips cpplint (only works in a git repo)# comment the line when this package is in a git repo and when# a copyright and license is added to all source filesset(ament_cmake_cpplint_FOUND TRUE)ament_lint_auto_find_test_dependencies()
endif()ament_package()

编译

colcon build --packages-select custom_service

在这里插入图片描述

注册

source install/setup.sh

经过注册后，我们可以在ROS2中查看这个自定义服务

ros2 interface show custom_service/srv/NavSatPoseBool

在这里插入图片描述

使用自定义服务的工程

创建包

ros2 pkg create --build-type ament_cmake --license Apache-2.0 custom_service_nodes --dependencies rclcpp custom_service

在这里插入图片描述
–dependencies参数可以帮我们在package.xml和CMakeLists.txt中自动添加相应依赖。此时我们添加上一步创建的custom_service。
此时目录结构如下
在这里插入图片描述

代码

在src目录下新建server.cpp和client.cpp，分别填入以下内容

#include "rclcpp/rclcpp.hpp"
#include "custom_service/srv/nav_sat_pose_bool.hpp"#include <memory>
#include <string>
#include <sstream>std::string serializeRequest(const custom_service::srv::NavSatPoseBool::Request &request) {std::ostringstream oss;oss << request.nav.service << " " << request.nav.status << " ";return oss.str();
}std::string serializeResponse(const custom_service::srv::NavSatPoseBool::Response &response) {std::ostringstream oss;oss << response.pose.pose.position.x << " " << response.pose.pose.position.y << " " << response.pose.pose.position.z << " " << response.pose.pose.orientation.x << " " << response.pose.pose.orientation.y << " " << response.pose.pose.orientation.z << " " << response.pose.pose.orientation.w << " " << response.boolvalue.data;return oss.str();
}void handle(const std::shared_ptr<custom_service::srv::NavSatPoseBool::Request> request,     std::shared_ptr<custom_service::srv::NavSatPoseBool::Response> response)  
{response->pose.pose.position.x = 1.0;response->pose.pose.position.y = 2.0;response->pose.pose.position.z = 3.0;response->pose.pose.orientation.x = 4.0;response->pose.pose.orientation.y = 5.0;response->pose.pose.orientation.z = 6.0;response->pose.pose.orientation.w = 7.0;response->boolvalue.data = true;RCLCPP_INFO(rclcpp::get_logger("rclcpp"), "Incoming request\na: %s", serializeRequest(*request).c_str()); RCLCPP_INFO(rclcpp::get_logger("rclcpp"), "sending back response: [%s]", serializeResponse(*response).c_str());
}int main(int argc, char **argv)
{rclcpp::init(argc, argv);std::shared_ptr<rclcpp::Node> node = rclcpp::Node::make_shared("custom_server");   rclcpp::Service<custom_service::srv::NavSatPoseBool>::SharedPtr service =               node->create_service<custom_service::srv::NavSatPoseBool>("handle",  &handle);   RCLCPP_INFO(rclcpp::get_logger("rclcpp"), "Ready to start service.");                     rclcpp::spin(node);rclcpp::shutdown();
}

#include "rclcpp/rclcpp.hpp"
#include "custom_service/srv/nav_sat_pose_bool.hpp"#include <chrono>
#include <cstdlib>
#include <memory>using namespace std::chrono_literals;std::string serializeRequest(const custom_service::srv::NavSatPoseBool::Request &request) {std::ostringstream oss;oss << request.nav.service << " " << request.nav.status << " ";return oss.str();
}std::string serializeResponse(const custom_service::srv::NavSatPoseBool::Response &response) {std::ostringstream oss;oss << response.pose.pose.position.x << " " << response.pose.pose.position.y << " " << response.pose.pose.position.z << " " << response.pose.pose.orientation.x << " " << response.pose.pose.orientation.y << " " << response.pose.pose.orientation.z << " " << response.pose.pose.orientation.w << " " << response.boolvalue.data;return oss.str();
}int main(int argc, char **argv)
{rclcpp::init(argc, argv);std::shared_ptr<rclcpp::Node> node = rclcpp::Node::make_shared("custom_client");  rclcpp::Client<custom_service::srv::NavSatPoseBool>::SharedPtr client =                node->create_client<custom_service::srv::NavSatPoseBool>("handle");          auto request = std::make_shared<custom_service::srv::NavSatPoseBool::Request>();request->nav.service = 1;request->nav.status = 2;                                                         while (!client->wait_for_service(1s)) {if (!rclcpp::ok()) {RCLCPP_ERROR(rclcpp::get_logger("rclcpp"), "Interrupted while waiting for the service. Exiting.");return 0;}RCLCPP_INFO(rclcpp::get_logger("rclcpp"), "service not available, waiting again...");}auto result = client->async_send_request(request);RCLCPP_INFO(rclcpp::get_logger("rclcpp"), "sending request: [%s]", serializeRequest(*request).c_str());// Wait for the result.if (rclcpp::spin_until_future_complete(node, result) ==rclcpp::FutureReturnCode::SUCCESS){RCLCPP_INFO(rclcpp::get_logger("rclcpp"), "receiving back response: [%s]", serializeResponse(*result.get()).c_str());} else {RCLCPP_ERROR(rclcpp::get_logger("rclcpp"), "Failed to call service custom_server");    }rclcpp::shutdown();return 0;
}

CMakeLists.txt

然后分别编译这两个文件成为可自行文件。

add_executable(server src/server.cpp)
ament_target_dependencies(server rclcpp custom_service)add_executable(client src/client.cpp)
ament_target_dependencies(client rclcpp custom_service)install(TARGETSserverclientDESTINATION lib/${PROJECT_NAME})

编译

 colcon build --packages-select custom_service_nodes

在这里插入图片描述

运行

在新的终端中，需要先初始化环境

source custom_service_nodes/install/setup.sh

然后执行server和client
在这里插入图片描述
在这里插入图片描述

工程地址

  • https://github.com/f304646673/ros2-examples/tree/main/custom_service
  • https://github.com/f304646673/ros2-examples/tree/main/custom_service_nodes

参考资料

  • https://docs.ros.org/en/jazzy/Tutorials/Beginner-Client-Libraries/Custom-ROS2-Interfaces.html

这篇关于Robot Operating System——自定义Service/Client通信消息结构的文章就介绍到这儿，希望我们推荐的文章对编程师们有所帮助！


http://www.chinasem.cn/article/1102238。

相关文章

使用Sentinel自定义返回和实现区分来源方式

使用Sentinel自定义返回和实现区分来源方式

《使用Sentinel自定义返回和实现区分来源方式》：本文主要介绍使用Sentinel自定义返回和实现区分来源方式,具有很好的参考价值,希望对大家有所帮助,如有错误或未考虑完全的地方,望不吝赐教... 目录Sentinel自定义返回和实现区分来源1. 自定义错误返回2. 实现区分来源总结Sentinel自定
阅读更多...
SpringKafka消息发布之KafkaTemplate与事务支持功能

SpringKafka消息发布之KafkaTemplate与事务支持功能

《SpringKafka消息发布之KafkaTemplate与事务支持功能》通过本文介绍的基本用法、序列化选项、事务支持、错误处理和性能优化技术,开发者可以构建高效可靠的Kafka消息发布系统,事务支... 目录引言一、KafkaTemplate基础二、消息序列化三、事务支持机制四、错误处理与重试五、性能优
阅读更多...
SpringIntegration消息路由之Router的条件路由与过滤功能

SpringIntegration消息路由之Router的条件路由与过滤功能

《SpringIntegration消息路由之Router的条件路由与过滤功能》本文详细介绍了Router的基础概念、条件路由实现、基于消息头的路由、动态路由与路由表、消息过滤与选择性路由以及错误处理... 目录引言一、Router基础概念二、条件路由实现三、基于消息头的路由四、动态路由与路由表五、消息过滤
阅读更多...
使用Java实现通用树形结构构建工具类

使用Java实现通用树形结构构建工具类

《使用Java实现通用树形结构构建工具类》这篇文章主要为大家详细介绍了如何使用Java实现通用树形结构构建工具类,文中的示例代码讲解详细,感兴趣的小伙伴可以跟随小编一起学习一下... 目录完整代码一、设计思想与核心功能二、核心实现原理1. 数据结构准备阶段2. 循环依赖检测算法3. 树形结构构建4. 搜索子
阅读更多...
利用Python开发Markdown表格结构转换为Excel工具

利用Python开发Markdown表格结构转换为Excel工具

《利用Python开发Markdown表格结构转换为Excel工具》在数据管理和文档编写过程中,我们经常使用Markdown来记录表格数据,但它没有Excel使用方便,所以本文将使用Python编写一... 目录1.完整代码2. 项目概述3. 代码解析3.1 依赖库3.2 GUI 设计3.3 解析 Mark
阅读更多...
如何自定义Nginx JSON日志格式配置

如何自定义Nginx JSON日志格式配置

《如何自定义NginxJSON日志格式配置》Nginx作为最流行的Web服务器之一,其灵活的日志配置能力允许我们根据需求定制日志格式,本文将详细介绍如何配置Nginx以JSON格式记录访问日志,这种... 目录前言为什么选择jsON格式日志？配置步骤详解1. 安装Nginx服务2. 自定义JSON日志格式各
阅读更多...
Android自定义Scrollbar的两种实现方式

Android自定义Scrollbar的两种实现方式

《Android自定义Scrollbar的两种实现方式》本文介绍两种实现自定义滚动条的方法,分别通过ItemDecoration方案和独立View方案实现滚动条定制化,文章通过代码示例讲解的非常详细,... 目录方案一：ItemDecoration实现（推荐用于RecyclerView）实现原理完整代码实现
阅读更多...
基于Spring实现自定义错误信息返回详解

基于Spring实现自定义错误信息返回详解

《基于Spring实现自定义错误信息返回详解》这篇文章主要为大家详细介绍了如何基于Spring实现自定义错误信息返回效果,文中的示例代码讲解详细,感兴趣的小伙伴可以跟随小编一起学习一下... 目录背景目标实现产出背景Spring 提供了 @RestConChina编程trollerAdvice 用来实现 HTT
阅读更多...
SpringSecurity 认证、注销、权限控制功能(注销、记住密码、自定义登入页)

SpringSecurity 认证、注销、权限控制功能(注销、记住密码、自定义登入页)

《SpringSecurity认证、注销、权限控制功能(注销、记住密码、自定义登入页)》SpringSecurity是一个强大的Java框架,用于保护应用程序的安全性,它提供了一套全面的安全解决方案... 目录简介认识Spring Security“认证”（Authentication）“授权” （Auth
阅读更多...
MyBatis-Plus中Service接口的lambdaUpdate用法及实例分析

MyBatis-Plus中Service接口的lambdaUpdate用法及实例分析

《MyBatis-Plus中Service接口的lambdaUpdate用法及实例分析》本文将详细讲解MyBatis-Plus中的lambdaUpdate用法,并提供丰富的案例来帮助读者更好地理解和应... 目录深入探索MyBATis-Plus中Service接口的lambdaUpdate用法及示例案例背景
阅读更多...

Copyright China编程 23002807@qq.com

沪ICP备2023033072号-2