[人工智能]话题通信实现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;
}

结果

无事发生（这是正确的因为没有编写日志内容）

如有想要打印可以在终端使用以下代码：

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

如有错误，敬请指正，欢迎交流，谢谢?(･ω･)ﾉ