【ROS2】MOMO的鱼香ROS2(四)ROS2入门篇——ROS2节点通信之话题与服务

2024-01-02 09:44

本文主要是介绍【ROS2】MOMO的鱼香ROS2(四)ROS2入门篇——ROS2节点通信之话题与服务,希望对大家解决编程问题提供一定的参考价值,需要的开发者们随着小编来一起学习吧!

ROS2节点通信之话题与服务点

  • 引言
  • 1 理解从通信开始
    • 1.1 TCP(传输控制协议)
    • 1.2 UDP(用户数据报协议)
    • 1.3 基于共享内存的IPC方式
  • 2 ROS2话题
    • 2.1 ROS2话题指令
    • 2.2 话题之RCLPY实现
      • 2.2.1 编写发布者
      • 2.2 2 编写订阅者
      • 2.2.3 运行测试
  • 3 ROS2服务
    • 3.1 ROS2服务指令
    • 3.2 服务之RCLPY实现
      • 3.2.1 编写客户端
      • 3.2 2 编写服务端
      • 3.2.3 运行测试

引言

笔者跟着鱼香ROS的ROS2学习之旅
学习参考:
【ROS2机器人入门到实战】
笔者的学习目录

  1. MOMO的鱼香ROS2(一)ROS2入门篇——从Ubuntu操作系统开启
  2. 【ROS2】MOMO的鱼香ROS2(二)ROS2入门篇——ROS2初体验
  3. ROS2】MOMO的鱼香ROS2(三)ROS2入门篇——ROS2第一个节点

专业术语认识

  1. TCP(传输控制协议)
  2. UDP(用户数据报协议)

1 理解从通信开始

通信的目的是在计算机系统中实现不同组件、进程或设备之间的信息和数据传递。通过通信,各个实体可以共享信息、协调行动并实现协同工作。在计算机领域,通信是构建分布式系统、网络和协议的基础。
通信的原理涉及两个主要方面:通信协议和通信方式。

通信协议定义了数据的格式、传输方式、错误检测和纠正等规则,以确保可靠的数据传输。
通信方式涉及了不同的通信介质和技术,包括网络通信和进程间通信(IPC)。

1.1 TCP(传输控制协议)

使用ping命令进行基于UDP的网络通信:

# 修改为自己的ip地址
ping 192.168.2.42
ping 192.168.2.36

在这里插入图片描述

1.2 UDP(用户数据报协议)

使用nc命令进行基于TCP的网络通信:

# 终端1
nc -l 1234
# 终端2
echo "Hello, TCP!" | nc 127.0.0.1 1234

在这里插入图片描述
关于TCP的通信可以参考笔者的博客:【Python】基于socket函数的TCP通信

1.3 基于共享内存的IPC方式

基于共享内存的进程间通信(IPC)方式
通过ipcs命令查看当前系统中的共享内存段:

ipcs -m

使用ipcrm命令删除不再需要的共享内存段:

ipcrm -m <shmid>

2 ROS2话题

一个节点发布数据到某个话题上,另外一个节点就可以通过订阅话题拿到数据。

ROS2话题通信其实还可以是1对n,n对1,n对n的。
同一个话题,所有的发布者和接收者必须使用相同消息接口。

在这里插入图片描述

2.1 ROS2话题指令

1.查看所有话题

ros2 topic list
# 增加查看消息类型
ros2 topic list -t

2.打印实时话题内容

ros2 topic echo  <topic_name> 

3.查看主题信息

ros2 topic info  <topic_name> 

2.2 话题之RCLPY实现

创建功能包

cd ROS_WS/colcon_ws/src
ros2 pkg create imu_py  --build-type ament_python --dependencies rclpy

创建节点文件

cd ROS_WS/colcon_ws/src/imu_py
touch imu_publisher.py
touch imu_subscribe.py

2.2.1 编写发布者

imu_publisher.py

# -*- coding: utf-8 -*-
"""
1.查看映射端口
ls /dev/ttyUSB*
2.更改端口的权限
sudo chmod 777 /dev/ttyUSB0
"""
import rclpy
from rclpy.node import Node
# 话题接口
from sensor_msgs.msg import Imu  # imu接口
# Usart Library
import serial# imu接收数据类型
class IMUPublisher(Node):def __init__(self,name):super().__init__(name)  # 继承父类,初始化名称self.get_logger().info("大家好,我是%s!" % name)self.publisher_node = self.create_publisher(Imu, 'imu_data', 1)  # 创建发布imu数据的发布者到话题:imu_data上# 串口初始化self.IMU_Usart = serial.Serial(port='/dev/ttyUSB0',  # 串口baudrate=115200,  # 波特率timeout=0.001  # 由于后续使用read_all按照一个timeout周期时间读取数据# imu在波特率115200返回数据时间大概是1ms,9600下大概是10ms# 所以读取时间设置0.001s)# 接收数据初始化self.ACC_X: float = 0.0  # X轴加速度self.ACC_Y: float = 0.0  # Y轴加速度self.ACC_Z: float = 0.0  # Z轴加速度self.GYRO_X: float = 0.0  # X轴陀螺仪self.GYRO_Y: float = 0.0  # Y轴陀螺仪self.GYRO_Z: float = 0.0  # Z轴陀螺仪self.roll: float = 0.0  # 横滚角self.pitch: float = 0.0  # 俯仰角self.yaw: float = 0.0  # 航向角self.leve: float = 0.0  # 磁场校准精度self.temp: float = 0.0  # 器件温度self.MAG_X: float = 0.0  # 磁场X轴self.MAG_Y: float = 0.0  # 磁场Y轴self.MAG_Z: float = 0.0  # 磁场Z轴self.Q0: float = 0.0  # 四元数Q0.0self.Q1: float = 0.0  # 四元数Q1self.Q2: float = 0.0  # 四元数Q2self.Q3: float = 0.0  # 四元数Q3# 判断串口是否打开成功if self.IMU_Usart.isOpen():print("open success")else:print("open failed")# 回调函数返回周期time_period = 0.001self.timer = self.create_timer(time_period, self.timer_callback)def timer_callback(self):"""定时器回调函数"""# ----读取IMU的内部数据-----------------------------------try:count = self.IMU_Usart.inWaiting()if count > 0:# 发布sensor_msgs/Imu 数据类型imu_data = Imu()imu_data.header.frame_id = "map"imu_data.header.stamp = self.get_clock().now().to_msg()imu_data.linear_acceleration.x = self.ACC_Ximu_data.linear_acceleration.y = self.ACC_Yimu_data.linear_acceleration.z = self.ACC_Zimu_data.angular_velocity.x = self.GYRO_X * 3.1415926 / 180.0  # unit transfer to rad/simu_data.angular_velocity.y = self.GYRO_Y * 3.1415926 / 180.0imu_data.angular_velocity.z = self.GYRO_Z * 3.1415926 / 180.0imu_data.orientation.x = self.Q0imu_data.orientation.y = self.Q1imu_data.orientation.z = self.Q2imu_data.orientation.w = self.Q3self.publisher_node.publish(imu_data)  # 发布imu的数据self.get_logger().info(f'发布了指令:{imu_data.header.frame_id}')    #打印一下发布的数据# --------------------------------------------------------# print('读取中')except KeyboardInterrupt:if serial != None:print("close serial port")self.IMU_Usart.close()def main(args=None):"""ros2运行该节点的入口函数编写ROS2节点的一般步骤1. 导入库文件2. 初始化客户端库3. 新建节点对象4. spin循环节点5. 关闭客户端库"""rclpy.init(args=args)  # 初始化rclpynode = IMUPublisher("imu_publisher")  # 新建一个节点rclpy.spin(node)  # 保持节点运行,检测是否收到退出指令(Ctrl+C)rclpy.shutdown()  # 关闭rclpy

2.2 2 编写订阅者

imu_subscribe.py

# -*- coding: utf-8 -*-
import rclpy
from rclpy.node import Node
# 话题接口
from sensor_msgs.msg import Imu  # imu接口class IMUSubscribe(Node):def __init__(self,name):super().__init__(name)self.get_logger().info("大家好,我是%s!" % name)self.imu_subscribe_node = self.create_subscription(Imu, 'imu_data',self.imu_callback, 1)  # 创建发布imu数据的发布者到话题:imu_data上def imu_callback(self, imu_data):self.get_logger().info(f'收到[{imu_data.header.frame_id}]命令')def main(args=None):rclpy.init(args=args) # 初始化rclpynode = IMUSubscribe("imu_subscribe")  # 新建一个节点rclpy.spin(node) # 保持节点运行,检测是否收到退出指令(Ctrl+C)rclpy.shutdown() # 关闭rclpy

2.2.3 运行测试

修改下setup.py

entry_points={'console_scripts': ["imu_publisher=imu_py.imu_publisher:main",  "imu_subscribe=imu_py.imu_subscribe:main",],},

发布节点

colcon build --packages-select imu_py
source install/setup.bash
ros2 run imu_py imu_publisher

订阅节点

source install/setup.bash
ros2 run imu_py imu_subscribe

在这里插入图片描述
可视化

rqt

在这里插入图片描述
上图中的节点名称取决于下图
在这里插入图片描述

在这里插入图片描述
在这里插入图片描述

3 ROS2服务

服务分为客户端和服务端,服务-客户端模型也可以称为请求-响应模型,不同于话题是没有返回的,适用于单向或大量的数据传递。而服务是双向的,客户端发送请求,服务端响应请求。

注意:
同一个服务(名称相同)有且只能有一个节点来提供
同一个服务可以被多个客户端调用

3.1 ROS2服务指令

启动服务端

ros2 run examples_rclpy_minimal_service service

1.查看所有服务

ros2 service list

2.手动调用服务

ros2 service call /add_two_ints example_interfaces/srv/AddTwoInts "{a: 5,b: 10}"

3.查看服务接口类型

ros2 service type   <service_name> 

4.查找使用某一接口的服务

ros2 service find example_interfaces/srv/AddTwoInts

3.2 服务之RCLPY实现

创建节点文件

cd ROS_WS/colcon_ws/src/imu_py
touch imu_client.py
touch imu_server.py

3.2.1 编写客户端

imu_client.py

# -*- coding: utf-8 -*-
import rclpy
from rclpy.node import Node
from example_interfaces.srv import AddTwoIntsclass ServiceClient(Node):def __init__(self,name):super().__init__(name)self.get_logger().info("节点已启动:%s!" % name)self.client_ = self.create_client(AddTwoInts,"add_two_ints_srv") def result_callback_(self, result_future):response = result_future.result()self.get_logger().info(f"收到返回结果:{response.sum}")def send_request(self, a, b):while rclpy.ok() and self.client_.wait_for_service(1)==False:self.get_logger().info(f"等待服务端上线....")request = AddTwoInts.Request()request.a = arequest.b = bself.client_.call_async(request).add_done_callback(self.result_callback_)def main(args=None):rclpy.init(args=args) # 初始化rclpynode = ServiceClient("service_client")  # 新建一个节点# 调用函数发送请求node.send_request(3,4)rclpy.spin(node) # 保持节点运行,检测是否收到退出指令(Ctrl+C)rclpy.shutdown() # 关闭rclpy

3.2 2 编写服务端

imu_server.py

# -*- coding: utf-8 -*-
import rclpy
from rclpy.node import Node
# 导入接口
from example_interfaces.srv import AddTwoIntsclass ServiceServer(Node):def __init__(self,name):super().__init__(name)self.get_logger().info("节点已启动:%s!" % name)self.add_ints_server_ = self.create_service(AddTwoInts,"add_two_ints_srv", self.handle_add_two_ints) def handle_add_two_ints(self,request, response):self.get_logger().info(f"收到请求,计算{request.a} + {request.b}")response.sum = request.a + request.breturn responsedef main(args=None):rclpy.init(args=args) # 初始化rclpynode = ServiceServer("service_server")  # 新建一个节点rclpy.spin(node) # 保持节点运行,检测是否收到退出指令(Ctrl+C)rclpy.shutdown() # 关闭rclpy

3.2.3 运行测试

修改下setup.py

entry_points={'console_scripts': ["imu_client=imu_py.imu_client:main",  "imu_server=imu_py.imu_server:main"],},

发布节点

colcon build --packages-select imu_py
source install/setup.bash
ros2 run imu_py imu_client

订阅节点

source install/setup.bash
ros2 run imu_py imu_server

在这里插入图片描述
可视化

rqt

在这里插入图片描述

这篇关于【ROS2】MOMO的鱼香ROS2(四)ROS2入门篇——ROS2节点通信之话题与服务的文章就介绍到这儿,希望我们推荐的文章对编程师们有所帮助!



http://www.chinasem.cn/article/562073

相关文章

如何搭建并配置HTTPD文件服务及访问权限控制

《如何搭建并配置HTTPD文件服务及访问权限控制》:本文主要介绍如何搭建并配置HTTPD文件服务及访问权限控制的问题,具有很好的参考价值,希望对大家有所帮助,如有错误或未考虑完全的地方,望不吝赐教... 目录一、安装HTTPD服务二、HTTPD服务目录结构三、配置修改四、服务启动五、基于用户访问权限控制六、

RabbitMQ工作模式中的RPC通信模式详解

《RabbitMQ工作模式中的RPC通信模式详解》在RabbitMQ中,RPC模式通过消息队列实现远程调用功能,这篇文章给大家介绍RabbitMQ工作模式之RPC通信模式,感兴趣的朋友一起看看吧... 目录RPC通信模式概述工作流程代码案例引入依赖常量类编写客户端代码编写服务端代码RPC通信模式概述在R

在Spring Boot中实现HTTPS加密通信及常见问题排查

《在SpringBoot中实现HTTPS加密通信及常见问题排查》HTTPS是HTTP的安全版本,通过SSL/TLS协议为通讯提供加密、身份验证和数据完整性保护,下面通过本文给大家介绍在SpringB... 目录一、HTTPS核心原理1.加密流程概述2.加密技术组合二、证书体系详解1、证书类型对比2. 证书获

Python模拟串口通信的示例详解

《Python模拟串口通信的示例详解》pySerial是Python中用于操作串口的第三方模块,它支持Windows、Linux、OSX、BSD等多个平台,下面我们就来看看Python如何使用pySe... 目录1.win 下载虚www.chinasem.cn拟串口2、确定串口号3、配置串口4、串口通信示例5

SpringCloud整合MQ实现消息总线服务方式

《SpringCloud整合MQ实现消息总线服务方式》:本文主要介绍SpringCloud整合MQ实现消息总线服务方式,具有很好的参考价值,希望对大家有所帮助,如有错误或未考虑完全的地方,望不吝赐... 目录一、背景介绍二、方案实践三、升级版总结一、背景介绍每当修改配置文件内容,如果需要客户端也同步更新,

linux服务之NIS账户管理服务方式

《linux服务之NIS账户管理服务方式》:本文主要介绍linux服务之NIS账户管理服务方式,具有很好的参考价值,希望对大家有所帮助,如有错误或未考虑完全的地方,望不吝赐教... 目录一、所需要的软件二、服务器配置1、安装 NIS 服务2、设定 NIS 的域名 (NIS domain name)3、修改主

基于C#实现MQTT通信实战

《基于C#实现MQTT通信实战》MQTT消息队列遥测传输,在物联网领域应用的很广泛,它是基于Publish/Subscribe模式,具有简单易用,支持QoS,传输效率高的特点,下面我们就来看看C#实现... 目录1、连接主机2、订阅消息3、发布消息MQTT(Message Queueing Telemetr

SpringBoot基于配置实现短信服务策略的动态切换

《SpringBoot基于配置实现短信服务策略的动态切换》这篇文章主要为大家详细介绍了SpringBoot在接入多个短信服务商(如阿里云、腾讯云、华为云)后,如何根据配置或环境切换使用不同的服务商,需... 目录目标功能示例配置(application.yml)配置类绑定短信发送策略接口示例:阿里云 & 腾

springboot项目如何开启https服务

《springboot项目如何开启https服务》:本文主要介绍springboot项目如何开启https服务方式,具有很好的参考价值,希望对大家有所帮助,如有错误或未考虑完全的地方,望不吝赐教... 目录springboot项目开启https服务1. 生成SSL证书密钥库使用keytool生成自签名证书将

使用Node.js制作图片上传服务的详细教程

《使用Node.js制作图片上传服务的详细教程》在现代Web应用开发中,图片上传是一项常见且重要的功能,借助Node.js强大的生态系统,我们可以轻松搭建高效的图片上传服务,本文将深入探讨如何使用No... 目录准备工作搭建 Express 服务器配置 multer 进行图片上传处理图片上传请求完整代码示例