ArduinoZironBot.cpp

#include <AFMotor.h>
#define SPEED 255

AF_DCMotor leftWheels(1);
AF_DCMotor rightWheels(2);
unsigned char serialData = 0x00;
void setup(){
  Serial.begin(9600);
  setSpeed();
}
void loop(){
  if(Serial.available() > 0){
    serialData = Serial.read();
    switch(serialData){
      case 48:
        stop();
        break;
      case 49:
        goForward();
        break;
      case 50:
        goBackward();
        break;
      case 51:
        turnLeft();
        break;
      case 52:
        turnRight();
        break;
    }
  }
}
void setSpeed(){
  leftWheels.setSpeed(SPEED);
  rightWheels.setSpeed(SPEED);
}
void turnLeft(){
  rightWheels.run(FORWARD);
  leftWheels.run(RELEASE);
}

void turnRight(){
  leftWheels.run(FORWARD);
  rightWheels.run(RELEASE);
}

void goBackward(){
  leftWheels.run(BACKWARD);
  rightWheels.run(BACKWARD);
}

void goForward(){
  leftWheels.run(FORWARD);
  rightWheels.run(FORWARD);
}

void stop(){
  leftWheels.run(RELEASE);
  rightWheels.run(RELEASE);
}