rosserial中的Publisher和Subscriber中的编程步骤

1.在一个话题上发布消息。

     可以使用ros::Publisher类创建一个句柄来在一个话题上发布消息，应该首先创建一个publisher将要使用的消息，然后在setup函数中调用advertise。整个程序的结构如下：

[html]  view plain copy

1. #include <ros.h>  
2. ros::NodeHandle nh;  
3.   
4. // before your setup() function  
5. std_msgs::String str_msg;  
6. ros::Publisher pub("foo", &str_msg);  
7.   
8. void setup(){  
9.     ...  
10.     nh.advertise(pub);  
11.     ...  
12. }  

     然后就可以发布一个消息了：

[cpp]  view plain copy

1. void loop()  
2. {  
3.    pub.publish( &str_msg );  
4.    nh.spinOnce();  
5. }  

     2.订阅一个话题

     订阅一个话题的第一步是包括头文件，并且创建一个回调函数。所有的rosserial消息存在于ros_lib文件夹下的package_name/msg_name。例如包括消息std_mgs/Float64时使用#include <std_msgs/Float64.h>。

     回调函数必须满足函数返回值为空且使用一个常引用作为函数的参数。

[html]  view plain copy

1. #include <std_msgs/Float64.h>  
2. void messageCb(const std_msgs::Float64& msg)  
3.   if(msg.data > 1.0)  
4.     digitalWrite(13, HIGH-digitalRead(13));   // blink the led  
5. }  

     为了建立实际的连接，我们必须静态的分配一个 ros::Subscriber 对象，它规定了你所使用的消息类型，并且在setup函数中调用 NodeHandle::subscribe 函数。

[cpp]  view plain copy

1. #include <ros.h>  
2. ros::NodeHandle nh;  
3.   
4. void messageCb(const std_msgs::Float64& msg)  
5.   if(msg.data > 1.0)  
6.     digitalWrite(13, HIGH-digitalRead(13));   // blink the led  
7. }  
8.   
9. ros::Subscriber<std_msgs::Float64> sub("your_topic", &messageCb);  
10.   
11. void setup()  
12. {  
13.     ...  
14.     nh.subscribe(sub);  
15.     ...  
16. }