话题通信实现C++

文章目录

步骤

发布者

步骤

发布者信息

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;
}

结果

无事发生(这是正确的因为没有编写日志内容)
话题通信实现C++
如有想要打印可以在终端使用以下代码:

rostopic echo "话题名称"

结果如下,data会一直打印,成功!
话题通信实现C++

优化

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;
}

运行结果

话题通信实现C++

订阅者

步骤

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;
}

运行结果

话题通信实现C++

优化

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

成功!!
话题通信实现C++

缺陷

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

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

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

上一篇:c – Plink传递参数


下一篇:C++类的拷贝控制demo