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
如有错误,敬请指正,欢迎交流,谢谢♪(・ω・)ノ