博主提示:本文基于ROS Kinetic Kame,若有更(gèng)新版本,可能存在细微差异,请大兄弟以官方资料为准。html
博主向来愚钝,若大兄弟发现该文章有不妥之处,还请速速告知。函数
首先要知道,这俩兄弟学名叫ROS消息回调处理函数。它俩一般会出如今ROS的主循环中,程序须要不断调用ros::spin() 或 ros::spinOnce(),二者区别在于前者调用后不会再返回,也就是你的主程序到这儿就不往下执行了,然后者在调用后还能够继续执行以后的程序。oop
其实消息回调处理函数的原理很是简单。咱们都知道,ROS存在消息发布订阅机制,什么?不知道?不知道还不快去:http://wiki.ros.org/ROS/Tutorials (ROS官方基础教程) 瞅瞅。设计
好,咱们继续,若是你的程序写了相关的消息订阅函数,那么程序在执行过程当中,除了主程序之外,ROS还会自动在后台按照你规定的格式,接受订阅的消息,可是所接到的消息并非马上就被处理,而是必须要等到ros::spin()或ros::spinOnce()执行的时候才被调用,这就是消息回到函数的原理,怎么样,简单吧,至于为何这么设计?咳咳,嗯,确定有他的道理。。。htm
就像上面说的,ros::spin() 在调用后不会再返回,也就是你的主程序到这儿就不往下执行了,而 ros::spinOnce() 后者在调用后还能够继续执行以后的程序。blog
其实看函数名也能理解个差很少,一个是一直调用;另外一个是只调用一次,若是还想再调用,就须要加上循环了。教程
这里必定要记住,ros::spin()函数通常不会出如今循环中,由于程序执行到spin()后就不调用其余语句了,也就是说该循环没有任何意义,还有就是spin()函数后面必定不能有其余语句(return 0 除外),有也是白搭,不会执行的。ros::spinOnce()的用法相对来讲很灵活,但每每须要考虑调用消息的时机,调用频率,以及消息池的大小,这些都要根据现实状况协调好,否则会形成数据丢包或者延迟的错误。进程
这里须要特别强调一下,若是大兄弟你的程序写了相关的消息订阅函数,那千万千万千万不要忘了在相应位置加上ros::spin()或者ros::spinOnce()函数,否则你是永远都得不到另外一边发出的数据或消息的,博主血的教训,万望紧记。。。get
ros::spin()函数用起来比较简单,通常都在主程序的最后,加入该语句就可。例子以下:回调函数
#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 (ros::ok()) { std_msgs::String msg; std::stringstream ss; ss << "hello world " << count; msg.data = ss.str(); ROS_INFO("%s", msg.data.c_str()); /** * 向 Topic: chatter 发送消息, 发送频率为10Hz(1秒发10次);消息池最大容量1000。 */ chatter_pub.publish(msg); loop_rate.sleep(); ++count; } return 0; }
#include "ros/ros.h" #include "std_msgs/String.h" void chatterCallback(const std_msgs::String::ConstPtr& msg) { ROS_INFO("I heard: [%s]", msg->data.c_str()); } int main(int argc, char **argv) { ros::init(argc, argv, "listener"); ros::NodeHandle n; ros::Subscriber sub = n.subscribe("chatter", 1000, chatterCallback); /** * ros::spin() 将会进入循环, 一直调用回调函数chatterCallback(),每次调用1000个数据。 * 当用户输入Ctrl+C或者ROS主进程关闭时退出, */ ros::spin(); return 0; }
对于ros::spinOnce()的使用,虽然说比ros::spin()更自由,能够出如今程序的各个部位,可是须要注意的因素也更多。好比:
/**接收端**/
#include "ros/ros.h" #include "std_msgs/String.h" void chatterCallback(const std_msgs::String::ConstPtr& msg) { /*...TODO...*/ } int main(int argc, char **argv) { ros::init(argc, argv, "listener"); ros::NodeHandle n; ros::Subscriber sub = n.subscribe("chatter", 2, chatterCallback); ros::Rate loop_rate(5); while (ros::ok()) { /*...TODO...*/ ros::spinOnce(); loop_rate.sleep(); } return 0; }
/*...TODO...*/ ros::Rate loop_rate(100); while (ros::ok()) { /*...TODO...*/ user_handle_events_timeout(...); ros::spinOnce(); loop_rate.sleep(); }