rccar_rosserial_arduino.ino~

#include <ros.h>
#include <AFMotor.h>
#include <geometry_msgs/Twist.h>
#include <std_msgs/String.h>
#include <robot_emulator/Request.h>
#include <robot_emulator/BootResponse.h>

AF_DCMotor motor1(1);

ros::NodeHandle nh;

robot_emulator::BootResponse boot_msg;
ros::Publisher bootPub("boot", &boot_msg);

char bootchar[11] = "locomotion";
const char* const bootword = "boot";

void runMotors( const geometry_msgs::Twist& input_msg){
   int forwardvel = input_msg.linear.x;
   if (forwardvel > 0) {
     motor1.setSpeed(forwardvel);
     motor1.run(FORWARD);
   }
   else if (forwardvel < 0) {
     motor1.setSpeed(forwardvel);
     motor1.run(BACKWARD);
   }
   else {
     motor1.setSpeed(0);
     motor1.run(RELEASE);
   }  
 }

void requests( const robot_emulator::Request& req_msg){
if(req_msg.request[0] == bootword[0]){
   boot_msg.moduletype = "locomotion";
   boot_msg.modulenumber = 1;
   bootPub.publish( &boot_msg );
}

}

ros::Subscriber<geometry_msgs::Twist> in_sub("locomotionInputs", &runMotors );
ros::Subscriber<robot_emulator::Request> req_sub("reqs", &requests );


void setup()
{
  
  motor1.setSpeed(200);
  motor1.run(RELEASE);

  nh.initNode();
  nh.advertise(bootPub);
  nh.subscribe(in_sub);
  nh.subscribe(req_sub);

}

void loop()
{
  
  nh.spinOnce();
  delay(100);
}