ROS中rosserial通讯协议初探

最新推荐文章于 2024-09-13 21:44:44 发布
最新推荐文章于 2024-09-13 21:44:44 发布
阅读量3.5k 收藏 19
点赞数 2
分类专栏： ros 通讯协议 arduino 文章标签： ros rosserial 串口通讯
版权声明：本文为博主原创文章，遵循 CC 4.0 BY-SA 版权协议，转载请附上原文出处链接和本声明。
本文链接：https://blog.csdn.net/qq_38288618/article/details/102931684
版权
ros 同时被 3 个专栏收录
64 篇文章 18 订阅
订阅专栏
arduino
41 篇文章 1 订阅
订阅专栏
通讯协议
24 篇文章 0 订阅
订阅专栏


ROS中rosserial通讯协议初探

串行的通讯，我们用串口模拟下通讯图

 

官方

http://wiki.ros.org/rosserial
rosserial
 

1概述


标准ROS序列化message的协议，可以让一个字符设备（单片机）通过串口或者网口就能实现多topics和services的功能。
1.1客户端库很多
1.2ROS端可以python也可以c++
1.3举例


2限制

2.1Message 最大size ，发布和订阅数量
AVR Model | Input/Output buffer sizes | Publishers/Subscribers

ATMEGA168 | 150/150 bytes | 6/6
ATMEGA328P | 280/280 bytes | 25/25
All others | 512/512 bytes | 25/25
可以自定义大小
2.2~2.4
float string array的数类型

3协议

协议就是在往串口发送的数据的基础上加上包头包尾，
并允许多个topics同时共享一个串口

3.1Packet Format

  1st Byte - Sync Flag (Value: 0xff)
  2nd Byte - Sync Flag / Protocol version  0xff on ROS Groovy, 0xfe on ROS Hydro, Indigo, and Jade.
  3rd Byte - Message Length (N) - Low Byte
  4th Byte - Message Length (N) - High Byte
  5th Byte - Checksum over message length
  6th Byte - Topic ID - Low Byte
  7th Byte - Topic ID - High Byte
  x Bytes  - Serialized Message Data
  Byte x+1 - Checksum over Topic ID and Message Data

横过来看
起始1  /  版本号1  /  内容长度L、H 2  /  内容长度校验1  / Topic ID L、H 2  /  内容x  /   内容校验1

校验算法
 

Message Length Checksum = 255 - ((Message Length High Byte + 
                                   Message Length Low Byte) % 256 )

Message Data Checksum = 255 - ((Topic ID Low Byte +
                                Topic ID High Byte + 
                                Data byte values) % 256)

由此校验算法上可见 Topic ID两个字节是作为校验数据的一部分，数据包长度这两个字节不算在内。


说Topics ID 0-100 系统保留 

如http://docs.ros.org/api/rosserial_msgs/html/msg/TopicInfo.html

uint16 ID_PUBLISHER=0
uint16 ID_SUBSCRIBER=1
uint16 ID_SERVICE_SERVER=2
uint16 ID_SERVICE_CLIENT=4
uint16 ID_PARAMETER_REQUEST=6
uint16 ID_LOG=7
uint16 ID_TIME=10
uint16 ID_TX_STOP=11
uint16 topic_id
string topic_name
string message_type
string md5sum
int32 buffer_size

此处的Topic ID的称谓值得注意，我觉得理解为 Topic类别ID 更好，他区分了这个数据包话题是发布、订阅或service服务端客户端等等

3.2话题协商 Topic Negotiation

在开始数据传输之前，上位机必须向嵌入式设备查询将要发布或订阅的主题的名称和类型。
主题协商包括对主题的查询、对主题数量的响应以及定义每个主题的数据包。对主题的请求使用主题ID 0。


主题请求时 Topic ID设置0

开始/版本号/长度/长度校验/Topic ID/内容校验

0xFF/0xFE/0x00/0x00/0xFF/0x00/0x00/0xFF

会话结束 topic_id = ID_TX_STOP=11（0x0B）

开始/版本号/长度/长度校验/Topic ID/内容校验

0xFF/0xFE/0x00/0x00/0xFF/0x0B/0x00/0xE3

上位机发过来的时钟/同步帧,（ID_TIME=10）
0xFF/0xFE/0x08/0x00/CHK/0x0A/0x00/8个bytes/CHK


当上位机发送主题请求后
0xff 0xfe 0x00 0x00 0xff 0x00 0x00 0xff
下位机应该发送
一系列响应包（消息类型rosserial-msgs/TopicInfo，每个包都包含有关特定主题的信息，用以下数据代替序列化的消息：

uint16 topic_id
  string topic_name
  string message_type
  string md5sum
  int32 buffer_size
注意这里又有一个topic_id，这个topic_id是运行程序中类实例的id，不能与 Topic ID混淆。
这五个数据合在一起是数据包的内容部分。

用单片机实现一个publisher，下面是实验数据分析

[20:46:35.143]发→◇FF FE 00 00 FF 00 00 FF □
[20:46:35.399]收←◆
FF FE 08 00 F7 
0A 00 ----------------------------0x000A=Topic ID  (ID_TIME=10)
00 00 00 00 00 00 00 00 
F5 --------------------------------0xf5包校验0xff-((0x0A+0x00+0+0+0+0+0+0+0+0)%0x100)


FF FE 48 00 B7 -------------------0x0048=72 包数据长度 0xb7=0xff-((0x48+0x00)%0x100)
00 00 -----------------------------0x0000= Topic ID(ID_PUBLISHER=0)
7D 00 -----------------------------0x7D=125 topic_id (publisher ID)
07 00 00 00 ----------------------0x0007=7，数据长度 topic_name="chatter"
63 68 61 74 74 65 72 
0F 00 00 00 ----------------------0x000f=15，数据长度 message_type ="std_msgs/String"
73 74 64 5F 6D 73 67 73 2F 53 
74 72 69 6E 67 
20 00 00 00 ----------------------0x0020=32，数据长度 md5sum="992ce8a1687cec8c8bd883ec73ca41d1"
39 39 32 63 65 38 61 31 36 38 
37 63 65 63 38 63 38 62 64 38 
38 33 65 63 37 33 63 61 34 31 
64 31 
18 01 00 00 ----------------------0x0118=280,是atmage328p的buffer_size  (看2.1)
0C --------------------------------0x0C 包校验

[20:46:36.404]收←◆
FF FE 10 00 EF 
7D 00 
0C 00 00 00 
68 65 6C 6C 6F 20 77 6F 72 6C 64 21 
F9 

[20:46:37.404]收←◆FF FE 10 00 EF 7D 00 0C 00 00 00 68 65 6C 6C 6F 20 77 6F 72 6C 64 21 F9 
[20:46:38.404]收←◆FF FE 10 00 EF 7D 00 0C 00 00 00 68 65 6C 6C 6F 20 77 6F 72 6C 64 21 F9 

FF FE 08 00 F7 
0A 00 
00 00 00 00 00 00 00 00 F5 

[20:46:39.402]收←◆FF FE 10 00 EF 7D 00 0C 00 00 00 68 65 6C 6C 6F 20 77 6F 72 6C 64 21 F9 
[20:46:40.403]收←◆FF FE 10 00 EF 7D 00 0C 00 00 00 68 65 6C 6C 6F 20 77 6F 72 6C 64 21 F9 
[20:46:41.402]收←◆FF FE 10 00 EF 7D 00 0C 00 00 00 68 65 6C 6C 6F 20 77 6F 72 6C 64 21 F9 FF FE 08 00 F7 0A 00 00 00 00 00 00 00 00 00 F5 
[20:46:42.402]收←◆FF FE 10 00 EF 7D 00 0C 00 00 00 68 65 6C 6C 6F 20 77 6F 72 6C 64 21 F9 
[20:46:43.401]收←◆FF FE 10 00 EF 7D 00 0C 00 00 00 68 65 6C 6C 6F 20 77 6F 72 6C 64 21 F9 
[20:46:44.401]收←◆FF FE 10 00 EF 7D 00 0C 00 00 00 68 65 6C 6C 6F 20 77 6F 72 6C 64 21 F9 FF FE 08 00 F7 0A 00 00 00 00 00 00 00 00 00 F5 
[20:46:45.401]收←◆FF FE 10 00 EF 7D 00 0C 00 00 00 68 65 6C 6C 6F 20 77 6F 72 6C 64 21 F9 
[20:46:46.400]收←◆FF FE 10 00 EF 7D 00 0C 00 00 00 68 65 6C 6C 6F 20 77 6F 72 6C 64 21 F9 

上个标记好的图吧

 

消息类型MD5的对应举例

https://github.com/frankjoshua/rosserial_arduino_lib/blob/master/src/std_msgs/Byte.h

"std_msgs/Byte"
MD5("byte data")="ad736a2e8818154c487bb80fe42ce43b"
"std_msgs/Bool"
MD5("bool data")="8b94c1b53db61fb6aed406028ad6332a"
"std_msgs/String"
MD5("string data")="992ce8a1687cec8c8bd883ec73ca41d1"


关于publisher的ID
https://github.com/frankjoshua/rosserial_arduino_lib/blob/master/src/ros/node_handle.h

void negotiateTopics()
      {
        rosserial_msgs::TopicInfo ti;
        int i;
    
        for(i = 0; i < MAX_PUBLISHERS; i++)
        {
          if(publishers[i] != 0) // non-empty slot
          {
        ReadBuffer buffer;
        
        ti.topic_id = publishers[i]->id_;
        ti.topic_name = (char *) buffer.readTopicName( publishers[i] );
        ti.message_type = (char *) buffer.readMsgInfo( publishers[i]->msg_->getType() );
        ti.md5sum = (char *) buffer.readMsgInfo( publishers[i]->msg_->getMD5() );
        ti.buffer_size = OUTPUT_SIZE;
        publish( publishers[i]->getEndpointType(), &ti );
....

3.3时间

通过向每个方向发送std_msg::Time来处理时间同步。嵌入式设备可以通过发送空时间消息从PC/平板电脑请求当前时间。返回的时间用于查找时钟偏移量。

4 Report a Bug

略

 

 

 

arduino测试源码


#include <ros.h>
#include <std_msgs/String.h>
#include <std_msgs/UInt16.h>
ros::NodeHandle  nh;

std_msgs::String str_msg;
ros::Publisher chatter("chatter", &str_msg);
std_msgs::String str_msg2;
ros::Publisher chatter2("chatter2", &str_msg2);
 
char hello[13] = "hello world!";
char hello2[13] = "hello hello!";



void servo_cb( const std_msgs::UInt16& cmd_msg){
  //servo.write(cmd_msg.data); //set servo angle, should be from 0-180  
  digitalWrite(13, HIGH-digitalRead(13));  //toggle led  
}


ros::Subscriber<std_msgs::UInt16> sub("servo", servo_cb);


void setup()
{
  pinMode(13, OUTPUT);
  //servo.attach(9); //attach it to pin 9
  nh.initNode();
  nh.advertise(chatter);
  nh.advertise(chatter2);
  nh.subscribe(sub);
}

void loop()
{
  str_msg.data = hello;
  chatter.publish( &str_msg );
  str_msg2.data = hello2;
  chatter2.publish( &str_msg2 );
  nh.spinOnce();
  delay(1000);
}

参考
rosserial_python serial_node.py分析
https://www.cnblogs.com/Montauk/p/7158597.html

rosserial_python serial_node.py分析--补遗
https://www.cnblogs.com/Montauk/p/7161927.html
 

qq_278667286
关注
专栏目录
rosserial简介
兴若磐石的博客
10-27 1万+
rosserial是用于非ROS设备与ROS设备进行通信的一种协议
Windows-Ros利用rosserial_windows实现通信
weixin_45589062的博客
03-20 1474
运行环境： ros：melodic windows 10 + VS2017 目的：使用windows上生成的命令控制Linux系统上ROS控制的小海龟移动 工作流程 1.从基于ROS的系统中，生成ros_lib代码 2.将ros_lib代码放入Visual Studios解决方案中 3.编写代码以使用ros_lib连接到ROS主服务器并发送/接收消息 4.在ROS master上运行rosserial_server套接字 5.编译并运行Windows应用程序。 第一步 生成ros_lib（
rosserial通信协议简介
热门推荐
倔强不倒翁的博客
10-04 1万+
rosserial通信协议介绍
STM32与ROS集成：rosserial_stm32使用指南及问题解决方案
最新发布
gitblog_09147的博客
09-13 426
STM32与ROS集成：rosserial_stm32使用指南及问题解决方案 rosserial_stm32 This is a part of [rosserial](https://github.com/ros-drivers/rosserial) repository to communicate with ROS...
ROS串口通信协议解析
栀末寸芒
08-12 2257
ROSserial 串口通信协议解析 1. 总览 ROS-serial是用于包装标准ROS序列化消息并在外部设备（例如串行端口或网络套接字）上多路复用多个主题和服务的协议。 2. 局限性 这里定义了发布主题消息的最大大小，发布者/订阅者的最大数量 对于rosserial_client，默认情况下，发布者和订阅者的数量限制为25，序列化和反序列化缓冲区的大小限制为512字节。 但是，这些数目和大小对于SRAM有限的微控制器来说太大了。rosserial_arduino的缓冲区大小和发布者/订阅者的数量现在取决
ROSNOTE : rosserial_python 通信协议
woodgril的博客
05-27 1412
rosserial是用于非ROS设备与ros设备进行通信的协议。 为非ROS 设备的应用程序提供了ROS节点和服务的发布/订阅功能。可通过串口或网络与ROS应用数据交互。 rosserial分为客户端和服务器两部分。rosserial客户端运行在运行在没有安装ROS的环境的应用中，通过串口或网络与运行在ROS 环境中的rosserial服务器连接，并通过服务器节点在ROS中发布/订阅话题。 链接：https://blog.csdn.net/scx837685002/article/details/1
[ROS 系列学习教程] ROS利用ros-kinetic-serial包与下位机串口通信
淋曦的进击手记
12-03 5676
一、使用ros-kinetic-serial包，首先安装这个package sudo apt install ros-kinetic-serial #可以将kinetic替换为你的ROS版本 二、连接设备并查看串口名 关于linux串口的操作看这里 Ubuntu关于串口的操作(查看串口信息、串口助手、串口权限) 三、在package中包编写代码 1. 在工作空间中创建你自己的package 创...
ROS-CAN通信协议程序
12-13
对于`ROS-CAN通信协议程序`，这个文件会提供关于如何与CANalyst-II分析仪配合使用以及如何在ROS环境中设置CAN通信的关键信息。 `CAN_Com`：这可能是程序的主执行文件或者是包含CAN通信功能的具体实现。它可能包含了...
STM32通过rosserial接入ROS通讯开发
01-19
主题：串口是一种设备间常用的通讯接口，rosserial将串口字符数据转发到标准ROS网络，并输出到rosout和其日志文件。本文将记录如何在ROS上使用其提供的serial包进行串口通信。 原文链接：...
ROSserial通信协议
05-12
ROSserial是一种ROS中的串行通信协议，它允许ROS节点与微控制器（如Arduino）等设备进行通信。ROSserial使用了轻量级的消息格式，可以在有限的带宽和资源下进行通信。 ROSserial协议的核心思想是将ROS消息转换为...
ros kinetic安装rosserial-arduino以及串口配置 ros与arduino学习（一）
01-06
ros kinetic安装rosserial-arduino以及串口配置 主要参考：https://blog.csdn.net/wanzew/article/details/80030768 https://blog.csdn.net/qq_24254419/article/details/62241770 ...1.安装arduinosudo apt-get ...
rosserial_stm32_master
08-18
rosserial_stm32-master.zip
ROS----ROSSerial的使用
weixin_30627341的博客
03-15 265
OS: ubuntu 16.04 ROS:kinetic 1.安装arduino sudo apt-get install arduino 2.安装ros包 sudo apt-get install ros-kinetic-rosserial-arduino sudo apt-get install ros-kinetic-rosserial 3.设置arduino的SketchBo...
rosserial: 为ROS设备提供轻量级通讯解决方案
gitblog_00006的博客
03-16 539
rosserial: 为ROS设备提供轻量级通讯解决方案 去发现同类优质开源项目:https://gitcode.com/ Rosserial是用于在ROS（Robot Operating System）系统中与硬件设备进行通信的开源库。它允许您通过串行接口（如USB或蓝牙）将嵌入式微控制器连接到ROS网络，并使您的设备能够像ROS节点一样运行。 Rosserial能用来做什么？ Rosseria...
rosserial_java_ROS-rosserial概述
weixin_34385646的博客
02-28 195
NodeHandles and Initialization1. 节点句柄rosserial_arduino允许您轻松地将Arduino或其他串行设备连接到ROS runtime graph。所有节点初始化和通信都通过节点句柄(NodeHandle)处理。在setup()函数之前创建NodeHandle非常简单：ros::NodeHandle nh;2. 初始化您可能在Arduino setup(...
Rosserial实现Windows-ROS交互操作
weixin_34081595的博客
10-17 598
安装 sudo apt-get install ros-indigo-rosserial-windows sudo apt-get install ros-indigo-rosserial-server 编译 rosrun rosserial_windows make_libraries.py my_library 运行后会产生一个my_library文件夹，...
ROS-rosserial概述(2)
博客
10-25 2124
Messages1. 消息生成2. 消息头文件(Message Header )生成 rosserial概述官网链接 1. 消息生成 与所有ROS客户端库一样，rosserial接受msg文件并为它们生成Arduino C / C ++源代码。 这种模式是： package_name / msg / Foo.msg→package_name :: Foo 同样，srv文件也生成了C / C ++源...
ROS学习-serial 1
金三亲的博客
08-01 745
serial并不在ROS安装时自带的库里面，但是学习serial有助于在ROS下进行串口编程。可以帮助我们使用串口通讯的方式与外接设备如激光雷达、嵌入式设备进行信息交互。 学习ROS-serial串口编程之前，需要了解的内容： linux系统下如何进行串口编程？ ROS串口编程实例① ROS串口编程实例② 数据类型的定义 相信如果是初学ROS或者嵌入式开发的你看到上面的文章之后，对ROS的se...
STM32F407移植ROS，使用PC端ROS和STM32F407端通过rosserial进行通信
weixin_50641310的博客
01-24 1278
6.运行串口节点，等待，配合stm32程序，如果出现 "robot_Star Connected!6. 新建一个终端，在终端输入以下指令可以查看到我们的话题列表。8. 新建一个终端，在终端往STM32订阅的话题。接下来就可以进行主题发布和订阅了。
评论
添加红包

请填写红包祝福语或标题

个

红包个数最小为10个

元

红包金额最低5元

当前余额3.43元 前往充值 >
需支付：10.00元
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付元
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明：

1.余额是钱包充值的虚拟货币，按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载，可以购买VIP、付费专栏及课程。

余额充值