【ROS】话题通信--从理论介绍到模型实现(C++)

1.简单介绍

话题通信是ROS中使用频率最高的一种通信模式，话题通信是基于发布订阅模式的，也即:一个节点发布消息，另一个节点订阅该消息。像雷达、摄像头、GPS… 等等一些传感器数据的采集，也都是使用了话题通信，换言之，话题通信适用于不断更新的、少逻辑处理的数据传输场景。

2.理论模型

该模型中涉及到三个角色:
ROS Master (管理者)
Talker (发布者)
Listener (订阅者)

ROS Master 负责保管 Talker 和 Listener 注册的信息，并匹配话题相同的 Talker 与 Listener，帮助 Talker 与 Listener 建立连接，连接建立后，Talker 可以发布消息，且发布的消息会被 Listener 订阅。
在这里插入图片描述
整个流程由以下步骤实现（引用自Autolabor-ROS）:

0.Talker注册

Talker启动后，会通过RPC在 ROS Master 中注册自身信息，其中包含所发布消息的话题名称。ROS Master 会将节点的注册信息加入到注册表中。

1.Listener注册

Listener启动后，也会通过RPC在 ROS Master 中注册自身信息，包含需要订阅消息的话题名。ROS Master 会将节点的注册信息加入到注册表中。

2.ROS Master实现信息匹配

ROS Master 会根据注册表中的信息匹配Talker 和 Listener，并通过 RPC 向 Listener 发送 Talker 的 RPC 地址信息。

3.Listener向Talker发送请求

Listener 根据接收到的 RPC 地址，通过 RPC 向 Talker 发送连接请求，传输订阅的话题名称、消息类型以及通信协议(TCP/UDP)。

4.Talker确认请求

Talker 接收到 Listener 的请求后，也是通过 RPC 向 Listener 确认连接信息，并发送自身的 TCP 地址信息。

5.Listener与Talker件里连接

Listener 根据步骤4 返回的消息使用 TCP 与 Talker 建立网络连接。

6.Talker向Listener发送消息

连接建立后，Talker 开始向 Listener 发布消息。

注意1:上述实现流程中，前五步使用的 RPC协议，最后两步使用的是 TCP 协议

注意2: Talker 与 Listener 的启动无先后顺序要求

注意3: Talker 与 Listener 都可以有多个

注意4: Talker 与 Listener 连接建立后，不再需要 ROS Master。即便关闭ROS Master，Talker 与 Listern 照常通信。

3.模型实现(C++)

首先创建工作空间，并shift+ctrl+B配置好编译文件，然后创建功能包plumbing_pub_sub并添加依赖，然后创建cpp源文件
在模型实现中，ROS master 不需要实现，而连接的建立也已经被封装了，所以大体流程如下：
1.编写发布方实现；
2.编写订阅方实现；
3.编辑配置文件；
4.编译并执行。

1.发布方实现：demo01_pub.cpp

/*需求: 实现基本的话题通信，一方发布数据，一方接收数据，实现的关键点:1.发送方2.接收方3.数据(此处为普通文本)PS: 二者需要设置相同的话题消息发布方:循环发布信息:HelloWorld 后缀数字编号实现流程:1.包含头文件 2.初始化 ROS 节点:命名(唯一)3.实例化 ROS 句柄4.实例化 发布者 对象5.组织被发布的数据，并编写逻辑发布数据*/
// 1.包含头文件 
#include "ros/ros.h"
#include "std_msgs/String.h" //普通文本类型的消息
#include <sstream>int main(int argc, char  *argv[])
{   //设置编码，避免中文乱码setlocale(LC_ALL,"");//2.初始化 ROS 节点:命名(唯一)// 参数1和参数2 后期为节点传值会使用// 参数3 是节点名称，是一个标识符，需要保证运行后，在 ROS 网络拓扑中唯一ros::init(argc,argv,"talker");//3.实例化 ROS 句柄ros::NodeHandle nh;//该类封装了 ROS 中的一些常用功能//4.实例化 发布者 对象//泛型: 发布的消息类型//参数1: 要发布到的话题//参数2: 队列中最大保存的消息数，超出此阀值时，先进的先销毁(时间早的先销毁)ros::Publisher pub = nh.advertise<std_msgs::String>("chatter",10);//5.组织被发布的数据，并编写逻辑发布数据//数据(动态组织)std_msgs::String msg;std::string msg_front = "Hello 你好！"; //消息前缀int count = 0; //消息计数器//逻辑(一秒1次/1HZ)ros::Rate r(1);//节点不死while (ros::ok()){//使用 stringstream 拼接字符串与编号std::stringstream ss;ss << msg_front << count;msg.data = ss.str();//发布消息pub.publish(msg);//加入调试，打印发送的消息ROS_INFO("发送的消息是:%s",msg.data.c_str());//根据前面制定的发送频率自动休眠 休眠时间 = 1/频率；r.sleep();count++;//循环结束前，让 count 自增}return 0;
}

2.订阅方实现：demo02_sub.cpp

/*需求: 实现基本的话题通信，一方发布数据，一方接收数据，实现的关键点:1.发送方2.接收方3.数据(此处为普通文本)消息订阅方:订阅话题并打印接收到的消息实现流程:1.包含头文件 2.初始化 ROS 节点:命名(唯一)3.实例化 ROS 句柄4.实例化 订阅者 对象5.处理订阅的消息(回调函数)6.设置循环调用回调函数*/
// 1.包含头文件 
#include "ros/ros.h"
#include "std_msgs/String.h"//通过msg_p获取并操作订阅到的数据
void doMsg(const std_msgs::String::ConstPtr& msg_p){ROS_INFO("我听见:%s",msg_p->data.c_str());// ROS_INFO("我听见:%s",(*msg_p).data.c_str());
}int main(int argc, char  *argv[])
{setlocale(LC_ALL,"");//2.初始化 ROS 节点:命名(唯一)ros::init(argc,argv,"listener");//3.实例化 ROS 句柄ros::NodeHandle nh;//4.实例化 订阅者 对象//5.处理订阅的消息(回调函数)ros::Subscriber sub = nh.subscribe<std_msgs::String>("chatter",10,doMsg);//6.设置循环调用回调函数ros::spin();//循环读取接收的数据，并调用回调函数处理return 0;
}

3.编辑配置文件CMakeList

add_executable(demo01_pubsrc/demo01_pub.cpp
)
add_executable(demo02_subsrc/demo02_sub.cpp
)target_link_libraries(demo01_pub${catkin_LIBRARIES}
)
target_link_libraries(demo02_sub${catkin_LIBRARIES}
)

然后ctrl + shift + B 编译后再执行：编译完成后启动roscore ，再启动发布节点，再启动订阅节点，效果如下。。。
在这里插入图片描述

一些注意事项：

补充0:
vscode 中的 main 函数 声明 int main(int argc, char const *argv[]){}，默认生成 argv 被 const 修饰，需要去除该修饰符

补充1:
ros/ros.h No such file or directory …
检查 CMakeList.txt find_package 依赖出现重复,删除多出来的包即可
在这里插入图片描述
补充2:
订阅时，第一条数据丢失
原因: 发送第一条数据时， publisher 还未在 roscore 注册完毕
解决: 注册后，加入休眠 ros::Duration(3.0).sleep(); 延迟第一条数据的发送

补充3:
可以新开一个终端，输入rqt_graph查看计算图
在这里插入图片描述

4.话题通信自定义msg

ROS 中通过 std_msgs 封装了一些原生的数据类型,比如:String、Int32、Int64、Char、Bool、Empty… 但是，这些数据一般只包含一个 data 字段，结构的单一意味着功能上的局限性，当传输一些复杂的数据，比如: 激光雷达的信息… std_msgs 由于描述性较差而显得力不从心，这种场景下可以使用自定义的消息类型

msgs只是简单的文本文件，每行具有字段类型和字段名称，可以使用的字段类型有：

int8, int16, int32, int64 (或者无符号类型: uint*)

float32, float64

string

time, duration

other msg files

variable-length array[] and fixed-length array[C]

ROS中还有一种特殊类型：Header，标头包含时间戳和ROS中常用的坐标帧信息。会经常看到msg文件的第一行具有Header标头。

现在要自定义消息，该消息包含人的信息：姓名、身高、年龄等。
1.定义msg文件
功能包下新建 msg 目录，添加文件 Person.msg

string name
uint16 age
float64 height

2.编辑配置文件
package.xml中添加编译依赖与执行依赖

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

一条是编译，一条是运行
在这里插入图片描述

CMakeLists.txt编辑 msg 相关配置

find_package(catkin REQUIRED COMPONENTSroscpprospystd_msgsmessage_generation
)
# 需要加入 message_generation,必须有 std_msgs

放开后多添加一个编译依赖
在这里插入图片描述

## 配置 msg 源文件
add_message_files(FILESPerson.msg
)

放开后添加自定义msg文件
在这里插入图片描述

# 生成消息时依赖于 std_msgs
generate_messages(DEPENDENCIESstd_msgs
)

直接找到并放开
在这里插入图片描述

#执行时依赖
catkin_package(
#  INCLUDE_DIRS include
#  LIBRARIES demo02_talker_listenerCATKIN_DEPENDS roscpp rospy std_msgs message_runtime
#  DEPENDS system_lib
)

放开后，多添加一个执行依赖
在这里插入图片描述

然后编译生成中间文件：之后只要调用头文件就可以正常使用了。
在这里插入图片描述

5.自定义msg的调用(C++)

vscode 配置
为了方便代码提示以及避免误抛异常，需要先配置 vscode，将前面生成的 head 文件路径配置进 c_cpp_properties.json 的 includepath属性:

右击头文件所在的包，在集成终端中打开，并输入pwd
会得到这个头文件的路径
在这里插入图片描述
在这里插入图片描述
把这个路径复制到这个文件的includePath中，把最后的包名改成 * * 可以包括进所有包，添加的时候，前一条路径最后面的逗号别忘了加
在这里插入图片描述

发布方
和之前一样的道理，只不过发送的消息不同

/*需求: 循环发布人的信息*/#include "ros/ros.h"
#include "plumbing_pub_sub/Person.h"int main(int argc, char *argv[])
{setlocale(LC_ALL,""); //避免输出乱码//1.初始化 ROS 节点ros::init(argc,argv,"banZhuRen");//2.创建 ROS 句柄ros::NodeHandle nh;//3.创建发布者对象ros::Publisher pub = nh.advertise<plumbing_pub_sub::Person>("chatter_person",1000);//4.组织被发布的消息，编写发布逻辑并发布消息//创建被发布的数据plumbing_pub_sub::Person p;p.name = "孙悟空";p.age = 2000;p.height = 1.45;//发布频率ros::Rate r(1);//循环发布while (ros::ok()){pub.publish(p);p.age += 1;ROS_INFO("我叫:%s,今年%d岁,高%.2f米", p.name.c_str(), p.age, p.height);r.sleep();ros::spinOnce();}return 0;
}

订阅方

/*需求: 订阅人的信息*/#include "ros/ros.h"
#include "plumbing_pub_sub/Person.h"void doPerson(const plumbing_pub_sub::Person::ConstPtr& person_p){ROS_INFO("订阅的人信息:%s, %d, %.2f", person_p->name.c_str(), person_p->age, person_p->height);
}int main(int argc, char *argv[])
{   setlocale(LC_ALL,"");//1.初始化 ROS 节点ros::init(argc,argv,"jiaZhang");//2.创建 ROS 句柄ros::NodeHandle nh;//3.创建订阅者对象//4.回调函数中处理 personros::Subscriber sub = nh.subscribe<plumbing_pub_sub::Person>("chatter_person",10,doPerson);//5.转头执行回调函数ros::spin();return 0;
}

配置CMakeList
需要添加 add_dependencies 用以设置所依赖的消息相关的中间文件。
以保证先编译自定义msg文件，再去编译cpp源文件

add_executable(新发布方源文件名 src/源文件名.cpp)
add_executable(新订阅方源文件名 src/源文件名.cpp)add_dependencies(新发布方源文件名 ${PROJECT_NAME}_generate_messages_cpp)
add_dependencies(新订阅方源文件名 ${PROJECT_NAME}_generate_messages_cpp)target_link_libraries(新发布方源文件名${catkin_LIBRARIES}
)
target_link_libraries(新订阅方源文件名${catkin_LIBRARIES}
)

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

然后编译运行即可。。。。效果和之前差不多，不过这次的消息类型是自定义的。

节点关系图
在这里插入图片描述

本文来自互联网用户投稿，该文观点仅代表作者本人，不代表本站立场。本站仅提供信息存储空间服务，不拥有所有权，不承担相关法律责任。如若转载，请注明出处：http://www.rhkb.cn/news/96783.html

如若内容造成侵权/违法违规/事实不符，请联系长河编程网进行投诉反馈email:809451989@qq.com，一经查实，立即删除！

相关文章

相机的位姿在地固坐标系ECEF和ENU坐标系的转换

相机的位姿在地固坐标系ECEF和ENU坐标系的转换

在地球科学和导航领域&#xff0c;通常使用地心地固坐标系&#xff08;ECEF&#xff0c;Earth-Centered, Earth-Fixed&#xff09;和东北天坐标系&#xff08;ENU&#xff0c;East-North-Up&#xff09;来描述地球上的位置和姿态。如下图所示&#xff1a; ​地心地固坐标ecef和…
阅读更多...
Python标准库-追踪异常，定位问题-traceback

Python标准库-追踪异常，定位问题-traceback

在日常的编程过程中&#xff0c;我们经常会遇到各种错误和异常。而当程序发生异常时&#xff0c;了解如何有效地追踪异常信息并定位问题&#xff0c;是每个开发者必备的技能之一。 Python 提供了一个强大的工具&#xff0c;称为 Traceback&#xff0c;它可以帮助我们跟踪异常的…
阅读更多...
java 工程管理系统源码+项目说明+功能描述+前后端分离 + 二次开发 em

java 工程管理系统源码+项目说明+功能描述+前后端分离 + 二次开发 em

Java版工程项目管理系统 Spring CloudSpring BootMybatisVueElementUI前后端分离 功能清单如下&#xff1a; 首页 工作台&#xff1a;待办工作、消息通知、预警信息&#xff0c;点击可进入相应的列表 项目进度图表&#xff1a;选择&#xff08;总体或单个&#xff09;项目显…
阅读更多...
Tomcat的部署及优化（多实例和动静分离）

Tomcat的部署及优化（多实例和动静分离）

目录 绪论 1、tomact 1.1 核心组件 1.2 什么是 servlet 1.3 什么是 JSP? 1.4 Tomcat 功能组件结构 1.5 Tomcat 请求过程 2、Tomcat 服务部署 2.1 tomcat自身优化&#xff1a; 2.2 内核优化 2.3 jvm 2.3.1 jvm配置 2.3.2 Tomcat配置JVM参数 2.3.3 jvm优化 3、tom…
阅读更多...
SpringBoot案例-员工管理-新增员工

SpringBoot案例-员工管理-新增员工

查看页面原型&#xff0c;明确需求 页面原型 需求 阅读接口文档 接口文档链接如下&#xff1a; 【腾讯文档】SpringBoot案例所需文档 https://docs.qq.com/doc/DUkRiTWVaUmFVck9N 思路分析 阅读需求文档后可知&#xff0c;前端发送请求的同时&#xff0c;将前端请求参数以…
阅读更多...
画质提升+带宽优化，小红书音视频团队端云结合超分落地实践

画质提升+带宽优化，小红书音视频团队端云结合超分落地实践

随着视频业务和短视频播放规模不断增长&#xff0c;小红书一直致力于研究&#xff1a;如何在保证提升用户体验质量的同时降低视频带宽成本&#xff1f; 在近日结束的音视频技术大会「LiveVideoStackCon 2023」上海站中&#xff0c;小红书音视频架构视频图像处理算法负责人剑寒向…
阅读更多...
使用el-tree实现自定义树结构样式

使用el-tree实现自定义树结构样式

实现效果: 直接上代码: <template><div><div class"tops"><el-tree :default-expanded-keys"[1]" ref"myTree" :data"data" :props"defaultProps" node-click"handleNodeClick" highlight…
阅读更多...
IDEA两种方法修改生成的jar包名字

IDEA两种方法修改生成的jar包名字

方法一&#xff1a; 直接修改pom文件中的如下部分 <artifactId>excelreport</artifactId> <version>0.0.1-SNAPSHOT</version> <name>excelreport</name> <description>excelreport</description> 修改完成后&#xff0c;点…
阅读更多...
LVS+Keepalived

LVS+Keepalived

Keepalived概述&#xff1a; keepalived软件 就是通过vrrp协议实现高可用功能 vrrp通信原理&#xff1a; vrrp就是虚拟路由冗余协议&#xff0c;它的出现就是为了解决静态路由的单点故障vrrp是通过一种竞选的一种协议机制将路由交给某台vrrp路由器vrrp用ip多播的方式【多播地…
阅读更多...
2023+HuggingGPT: Solving AI Tasks with ChatGPT and itsFriends in Hugging Face

2023+HuggingGPT: Solving AI Tasks with ChatGPT and itsFriends in Hugging Face

摘要&#xff1a; 语言是llm(例如ChatGPT)连接众多AI模型(例如hugs Face)的接口&#xff0c;用于解决复杂的AI任务。在这个概念中&#xff0c;llms作为一个控制器&#xff0c;管理和组织专家模型的合作。LLM首先根据用户请求规划任务列表&#xff0c;然后为每个任务分配专家模…
阅读更多...
LLaMA模型泄露 Meta成最大受益者

LLaMA模型泄露 Meta成最大受益者

一份被意外泄露的谷歌内部文件&#xff0c;将Meta的LLaMA大模型“非故意开源”事件再次推到大众面前。“泄密文件”的作者据悉是谷歌内部的一位研究员&#xff0c;他大胆指出&#xff0c;开源力量正在填平OpenAI与谷歌等大模型巨头们数年来筑起的护城河&#xff0c;而最大的受益…
阅读更多...
如何使用Kali Linux进行渗透测试？

如何使用Kali Linux进行渗透测试？

1. 渗透测试简介 渗透测试是通过模拟恶意攻击&#xff0c;评估系统、应用或网络的安全性的过程。Kali Linux为渗透测试人员提供了丰富的工具和资源&#xff0c;用于发现漏洞、弱点和安全风险。 2. 使用Kali Linux进行渗透测试的步骤 以下是使用Kali Linux进行渗透测试的基本…
阅读更多...
万宾燃气管网监测解决方案，守护城市生命线安全

万宾燃气管网监测解决方案，守护城市生命线安全

方案背景 城市燃气管网作为连接天然气长输管线与天然气用户的桥梁&#xff0c;担负着向企业和居民用户直接供气的重要职责。随着城市燃气需求的急剧增加&#xff0c;城市燃气管网规模日趋庞大&#xff0c;安全隐患和风险也随之增加。目前&#xff0c;我国燃气管网的运行仍存在…
阅读更多...
3D沉浸式旅游网站开发案例复盘【Three.js】

3D沉浸式旅游网站开发案例复盘【Three.js】

Plongez dans Lyon网站终于上线了。 我们与 Danka 团队和 Nico Icecream 共同努力&#xff0c;打造了一个令我们特别自豪的流畅的沉浸式网站。 这个网站是专为 ONLYON Tourism 和会议而建&#xff0c;旨在展示里昂最具标志性的活动场所。观看简短的介绍视频后&#xff0c;用户…
阅读更多...
react之react-redux的介绍、基本使用、获取状态、分发动作、数据流、reducer的分离与合并等

react之react-redux的介绍、基本使用、获取状态、分发动作、数据流、reducer的分离与合并等

react之react-redux的介绍、基本使用、获取状态、分发动作、数据流、reducer的分离与合并等 一、react-redux介绍二、React-Redux-基本使用三、获取状态useSelector四、分发动作useDispatch五、 Redux 数据流六、代码结构七、ActionType的使用八、Reducer的分离与合并九、购物挣…
阅读更多...
【数据结构】二叉树篇|超清晰图解和详解：二叉树的最近公共祖先

【数据结构】二叉树篇|超清晰图解和详解：二叉树的最近公共祖先

博主简介&#xff1a;努力学习的22级计算机科学与技术本科生一枚&#x1f338;博主主页&#xff1a; 是瑶瑶子啦每日一言&#x1f33c;: 你不能要求一片海洋&#xff0c;没有风暴&#xff0c;那不是海洋&#xff0c;是泥塘——毕淑敏 目录 一、题目二、题解三、代码 一、题目 …
阅读更多...
【宝藏系列】一文讲透C语言数组与指针的关系

【宝藏系列】一文讲透C语言数组与指针的关系

【宝藏系列】嵌入式 C 语言代码优化技巧【超详细版】 文章目录 【宝藏系列】嵌入式 C 语言代码优化技巧【超详细版】&#x1f468;‍&#x1f3eb;前言1️⃣指针1️⃣1️⃣指针的操作1️⃣2️⃣关于指针定义的争议1️⃣3️⃣对教材错误写法的小看法 2️⃣指针和数组的区别2️⃣…
阅读更多...
内网穿透——使用Windows自带的网站程序建立网站

内网穿透——使用Windows自带的网站程序建立网站

文章目录 1.前言2.Windows网页设置2.1 Windows IIS功能设置2.2 IIS网页访问测试 3. Cpolar内网穿透3.1 下载安装Cpolar3.2 Cpolar云端设置3.3 Cpolar本地设置 4.公网访问测试5.结语 1.前言 在网上各种教程和介绍中&#xff0c;搭建网页都会借助各种软件的帮助&#xff0c;比如…
阅读更多...
java 使用log4j显示到界面和文件 并格式化

java 使用log4j显示到界面和文件 并格式化

1.下载log4j jar包https://dlcdn.apache.org/logging/log4j/2.20.0/apache-log4j-2.20.0-bin.zip 2. 我只要到核心包 &#xff0c;看需要 sources是源码包&#xff0c;可以看到说明。在IDEA里先加入class jar后&#xff0c;再双击这个class jar包或或右键选Navigate ,Add ,…
阅读更多...
Xxl-job安装部署以及SpringBoot集成Xxl-job使用

Xxl-job安装部署以及SpringBoot集成Xxl-job使用

1、安装Xxl-job&#xff1a; 可以使用docker拉取镜像部署和源码编译两种方式&#xff0c;这里选择源码编译安装。 代码拉取地址&#xff1a; https://github.com/xuxueli/xxl-job/tree/2.1.2 官方开发文档&#xff1a; https://www.xuxueli.com/xxl-job/#%E3%80%8A%E5%88%…
阅读更多...
最新文章
推荐文章

Copyright @ 2022~2023