一、第一种安装方式（不支持自定义消息）
第一步打开官网
http://wiki.ros.org/rosserial_arduino/Tutorials/Arduino%20IDE%20Setup
第二步按第一种方式安装
第三步生成arduino ros库
第四步编译arduino等等等
二、第一种安装方式的问题
一切正常了吧，但如果使用自定义数据类型，会发现source /opt/ros/indigo/setup.bash会找不到在catkin_ws中的自定义类型。
但如果使用source catkin_ws/devel/setup.bash,你会发现无法找到ros_rosserial这个包。
所以需要再进行一次第二种安装（也许第一种还有其他改进方法）
三、接着进行第二种安装方式
之后可以开始自定义消息类型了
四、自定义消息类型
参见官网
http://wiki.ros.org/ROS/Tutorials/CreatingMsgAndSrv
在自己包里创建自定义数据类型后，catkin_make
重复一中的第三步，生成arduino ros库，之后就会在arduino的roslibaray中找到自定义消息类型的.h文件了。
如图mycat包中cat自定义消息类型
四、如果只用第二种方法
用第二种方法安装ros_rosserial，在生成arduino ros库后，arduino无法编译ros内容
五、备注
也许是我出错了
我第一个电脑中默认source catkin_ws/devel/setup.bash
但后来只用第二种方法时忘了source究竟是不是指向了catkin_ws/devel/setup.bash
第一种方法是否还可以挽救下？？使用rospack profile。
六、arduino代码
事实上在rosrun rosserial_python serial_node.py /dev/ttyUSB0后
在arduino端生成一个节点，含有发布器或订阅器。
代码里的数据类型就是ros里的消息类型，必须先导入消息的头文件。
七、发布器（publisher）（多线程）
*
* rosserial Publisher Example
* Prints "hello world!"
*/
#include <NewPing.h>
#include <ros.h>
#include <std_msgs/Float32.h>
ros::NodeHandle nh;
const int TrigPin2 = 4;
const int EchoPin2 = 5;
const int TrigPin1 = 2;
const int EchoPin1 = 3;
const int TrigPin3= 8;
const int EchoPin3 = 9;
std_msgs::Float32 str_msg1;
std_msgs::Float32 str_msg2;
std_msgs::Float32 str_msg3;
ros::Publisher chatter1("chatter1", &str_msg1);
ros::Publisher chatter2("chatter2", &str_msg2);
ros::Publisher chatter3("chatter3", &str_msg3);
float distance1;
float distance2;
float distance3;
NewPing sonar1(TrigPin1, EchoPin1, 200);
NewPing sonar2(TrigPin2, EchoPin2, 200);
NewPing sonar3(TrigPin3, EchoPin3, 200);
void setup()
{
// 初始化串口通信及连接SR04的引脚
Serial.begin(9600); Serial.println("Ultrasonic sensor:");
nh.initNode();
nh.advertise(chatter1);
nh.advertise(chatter2);
nh.advertise(chatter3);
}
void loop()
{
distance1 = sonar1.ping_cm();
str_msg1.data =distance1;
chatter1.publish( &str_msg1 );
// 检测脉冲宽度，并计算出距离
distance2 = sonar2.ping_cm();
str_msg2.data =distance2;
chatter2.publish( &str_msg2 );
distance3 = sonar3.ping_cm();
str_msg3.data =distance3;
chatter3.publish( &str_msg3);
nh.spinOnce();
delay(15);
}
八、订阅器
实例一无参实例
/*
* rosserial Subscriber Example
* Blinks an LED on callback
*/
#include <Servo.h>
#include <ros.h>
#include <std_msgs/Empty.h>
Servo myservo;
ros::NodeHandle nh;
int pos;
void messageCb( const std_msgs::Empty& toggle_msg){
digitalWrite(13, HIGH-digitalRead(13)); // blink the led
for(pos = 0; pos < 180; pos += 1) // goes from 0 degrees to 180 degrees
{ // in steps of 1 degree
myservo.write(pos); // tell servo to go to position in variable 'pos'
delay(15); // waits 15ms for the servo to reach the position
}
for(pos = 180; pos>=1; pos-=1) // goes from 180 degrees to 0 degrees
{
myservo.write(pos); // tell servo to go to position in variable 'pos'
delay(15); // waits 15ms for the servo to reach the position
}
}
ros::Subscriber<std_msgs::Empty> sub("toggle_led", &messageCb );
///toggle_led is pubisher in ros
void setup()
{ myservo.attach(9);
pinMode(13, OUTPUT);
nh.initNode();
nh.subscribe(sub);
}
void loop()
{
nh.spinOnce();
delay(1);
}
在nh节点激活后
void messageCb(）函数会被调用执行。
实例二有参实例
*
* rosserial Servo Control Example
*
* This sketch demonstrates the control of hobby R/C servos
* using ROS and the arduiono
*
* For the full tutorial write up, visit
* www.ros.org/wiki/rosserial_arduino_demos
*
* For more information on the Arduino Servo Library
* Checkout :
* http://www.arduino.cc/en/Reference/Servo
*/
#if defined(ARDUINO) && ARDUINO >= 100
#include "Arduino.h"
#else
#include <WProgram.h>
#endif
#include <Servo.h>
#include <ros.h>
#include <std_msgs/UInt16.h>
ros::NodeHandle nh;
Servo servo;
void servo_cb( const std_msgs::UInt16& cmd_msg){
servo.write(cmd_msg.data); //set servo angle, should be from 0-180
digitalWrite(13, HIGH-digitalRead(13)); //toggle led
}
ros::Subscriber<std_msgs::UInt16> sub("servo", servo_cb);
void setup(){
pinMode(13, OUTPUT);
nh.initNode();
nh.subscribe(sub);
servo.attach(9); //attach it to pin 9
}
void loop(){
nh.spinOnce();
delay(1);
}九、自定义消息类型
（原ros_rosserial自带adc.h自定义消息类型）（自定义消息还可以，但自定义数组一直搞不定）
发布器
#include <ros.h>
#include <mycat/cat.h>
ros::NodeHandle nh;
mycat::cat cat_msg;
ros::Publisher p("cat", &cat_msg);
void setup()
{
nh.initNode();
nh.advertise(p);
}
//We average the analog reading to elminate some of the noise
void loop()
{
cat_msg.num = 1;
cat_msg.num1 = 2;
cat_msg.num2 = 3;
cat_msg.num3 = 4;
p.publish(&cat_msg);
nh.spinOnce();
}
订阅器
#include <Servo.h>
#include <ros.h>
#include <mycat/cat.h>
ros::NodeHandle nh;
Servo servo;
void servo_cb( const mycat::cat& cmd_msg){
servo.write(cmd_msg.num); //set servo angle, should be from 0-180
delay(1000);
servo.write(cmd_msg.num1); //set servo angle, should be from 0-180
delay(1000);
servo.write(cmd_msg.num2); //set servo angle, should be from 0-180
delay(1000);
servo.write(cmd_msg.num3); //set servo angle, should be from 0-180
delay(1000);
}
ros::Subscriber<mycat::cat> sub("cat", servo_cb);
void setup(){
nh.initNode();
nh.subscribe(sub);
servo.attach(9); //attach it to pin 9
}
void loop(){
nh.spinOnce();
delay(100);
}