ICode9

精准搜索请尝试: 精确搜索
首页 > 编程语言> 文章详细

话题通信实现C++

2022-01-16 23:34:17  阅读:203  来源: 互联网

标签:std include msgs 话题 C++ 通信 发布者 msg ros


文章目录

步骤

发布者

步骤

发布者信息

1.导入头文件

#include"ros/ros.h"//ros包
#include"std_msgs/String.h"//ros文本类型

2.初始化ros节点

ros::init(argc,argv,"writer");//创建节点为writer的节点

3.创建节点句柄

ros::NodeHandle nh;

4.创建发布者对象

ros::Publisher pub = nh.advertise<std_msgs::String>("article",10);//用句柄的advertise<文本类型>(“话题”,缓存个数)

消息

1.创建被发布的消息

std_msgs::String msg;//消息为文本类型

2.编写循环

while(ros::ok)//ros::ok时,ros还在运行中
    {
        msg.data = "perfect";
        pub.publish(msg);
    }

3.数据内容

msg.data = "perfect";//消息内容

4.发布数据

pub.publish(msg);//发布者对象发布数据

完整代码

#include"ros/ros.h"
#include"std_msgs/String.h"

int main(int argc, char  *argv[])
{
    ros::init(argc,argv,"writer");
    ros::NodeHandle nh;
    ros::Publisher pub = nh.advertise<std_msgs::String>("article",10);
    std_msgs::String msg;
    while(ros::ok)
    {
        msg.data = "perfect";
        pub.publish(msg);
    }
    return 0;
}

结果

无事发生(这是正确的因为没有编写日志内容)
请添加图片描述
如有想要打印可以在终端使用以下代码:

rostopic echo "话题名称"

结果如下,data会一直打印,成功!
在这里插入图片描述

优化

1.设置发布频率

ros::Rate rate(10);//一秒10次

2.消息编号与消息拼接

		std::stringstream out;//需要导入库#include<sstream>,这句一定要放在循环里,否则打印速度会有问题
        out<< num << "perfect";
        num++;

3.消息类型转换

msg.data = out.str();//把流的数据转化为字符串类型

4.用日志打印

ROS_INFO("%s",msg.data.c_str());//消息类型也要转化为c_str类型

5.休眠

rate.sleep();//休眠时间 = 1/频率

完整代码

#include"ros/ros.h"
#include"std_msgs/String.h"
#include<sstream>

int main(int argc, char  *argv[])
{
    ros::init(argc,argv,"writer");
    ros::NodeHandle nh;
    ros::Publisher pub = nh.advertise<std_msgs::String>("article",10);
    std_msgs::String msg;
    ros::Rate rate(10);
    
    int num = 0;
    while(ros::ok)
    {
        
        std::stringstream out;
        
        out<< num << "perfect";
        num++;
        msg.data = out.str();
        pub.publish(msg);
        ROS_INFO("%s",msg.data.c_str());
        rate.sleep();
    }
    return 0;
}

运行结果

在这里插入图片描述

订阅者

步骤

1.创建订阅者对象

ros::Subscriber sub= nh.subscribe("article",10,doMsg);

2.创建回调函数

void doMsg(const std_msgs::String::ConstPtr& msg){//常指针
    ROS_INFO("我收到:%s",msg->data.c_str());
}

3.回调函数

ros::spin();

4.设置中文可以打印

setlocale(LC_ALL,"");

完整代码

#include"ros/ros.h"
#include"std_msgs/String.h"

void doMsg(const std_msgs::String::ConstPtr& msg){
    ROS_INFO("我收到:%s",msg->data.c_str());
}

int main(int argc, char  *argv[])
{
    setlocale(LC_ALL,"");
    ros::init(argc,argv,"reader");
    ros::NodeHandle nh;
    ros::Subscriber sub= nh.subscribe("article",10,doMsg);
    ros::spin();
    

    return 0;
}

运行结果

在这里插入图片描述

优化

我们会发现当先启动接收者,再启动发布者时,我们收到的数据并不全面。这是因为:发布者还未在 roscore 注册完毕
解决方法:在发布者里加入休眠语句
ros::Duration(3.0).sleep();//休眠三秒

成功!!
在这里插入图片描述

缺陷

发布者窗口无法用ctrl+c停止

这是我学习的视频教程,感谢赵虚左老师的讲课。
​www.bilibili.com/video/BV1Ci4y1L7ZZ?p=20

如有错误,敬请指正,欢迎交流,谢谢♪(・ω・)ノ

标签:std,include,msgs,话题,C++,通信,发布者,msg,ros
来源: https://blog.csdn.net/m0_51302822/article/details/122529463

本站声明: 1. iCode9 技术分享网(下文简称本站)提供的所有内容,仅供技术学习、探讨和分享;
2. 关于本站的所有留言、评论、转载及引用,纯属内容发起人的个人观点,与本站观点和立场无关;
3. 关于本站的所有言论和文字,纯属内容发起人的个人观点,与本站观点和立场无关;
4. 本站文章均是网友提供,不完全保证技术分享内容的完整性、准确性、时效性、风险性和版权归属;如您发现该文章侵犯了您的权益,可联系我们第一时间进行删除;
5. 本站为非盈利性的个人网站,所有内容不会用来进行牟利,也不会利用任何形式的广告来间接获益,纯粹是为了广大技术爱好者提供技术内容和技术思想的分享性交流网站。

专注分享技术,共同学习,共同进步。侵权联系[81616952@qq.com]

Copyright (C)ICode9.com, All Rights Reserved.

ICode9版权所有