您的位置:首页 > 运维架构

ROS中节点在每次接收到消息之后都发布一条消息的反馈topic

2014-11-13 23:09 525 查看
#include "ros/ros.h"
#include "std_msgs/String.h"
#include <sstream>
ros::Publisher chatter_pub;
ros::Subscriber sub;
void callback()
{
std_msgs::String msg;

std::stringstream ss;
msg.data = "test";

ROS_INFO("%s", msg.data.c_str());

chatter_pub.publish(msg);
}
void function(const std_msgs::StringPtr &msg)
{
callback();
}

int main(int argc, char **argv)
{

ros::init(argc, argv, "talker");

ros::NodeHandle n;

chatter_pub = n.advertise<std_msgs::String>("chatter", 1000);
sub = n.subscribe("/test", 1, &function);

ros::Rate loop_rate(10);

ROS_INFO("Please send message!");

ros::spin();

return 0;
}


如果发布一条消息之后直接退出节点,则可以这样:

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

#include <sstream>

int main(int argc, char **argv)
{

ros::init(argc, argv, "talker");

ros::NodeHandle n;

ros::Publisher chatter_pub = n.advertise<std_msgs::String>("chatter", 1000);

ros::Rate loop_rate(10);

int count = 0;

while (count < 1)
{

std_msgs::String msg;

std::stringstream ss;
ss << "hello world " << count;
msg.data = ss.str();

ROS_INFO("%s", msg.data.c_str());
if(chatter_pub.getNumSubscribers() == 1)
{
chatter_pub.publish(msg);

count ++;

ros::spinOnce();

loop_rate.sleep();
++count;
}
}

return 0;
}
内容来自用户分享和网络整理,不保证内容的准确性,如有侵权内容,可联系管理员处理 点击这里给我发消息
标签: