robot.ino

#include <Adafruit_MotorShield.h>
#include <Wire.h>
/*
Nathan Carlson
January 2015
http://nathancarlson-projects.blogspot.com/2015/01/blog-post.html
*/


Adafruit_MotorShield AFMS = Adafruit_MotorShield();
Adafruit_DCMotor *RightMotor = AFMS.getMotor(1);
Adafruit_DCMotor *LeftMotor = AFMS.getMotor(3);

char ser;
void setup() {
  Serial.begin(9600);
  AFMS.begin();
}

void loop() {

 if (Serial.available() > 0) {
    ser = Serial.read();
    }

  uint8_t i;
  if (ser == 'w'){

  //Serial.println("Forward");
  RightMotor->run(FORWARD);
  LeftMotor->run(FORWARD);
  RightMotor->setSpeed(175);
  LeftMotor->setSpeed(175);
 }

 // Backwards Motors
 if (ser == 's'){
  RightMotor->run(BACKWARD);
  LeftMotor->run(BACKWARD);
  RightMotor->setSpeed(175);
  LeftMotor->setSpeed(175);

 }
 if (ser == 'p'){
  Serial.println("Stop");
  RightMotor->run(RELEASE);
  LeftMotor->run(RELEASE);
  delay(1000);
 }


 // Right Turn
 if (ser == 'd'){
  RightMotor->run(BACKWARD);
  LeftMotor->run(FORWARD);
  RightMotor->setSpeed(125);
  LeftMotor->setSpeed(1);
 }

 // Left Turn
 if (ser == 'a'){
  RightMotor->run(FORWARD);
  LeftMotor->run(BACKWARD);
  RightMotor->setSpeed(1);
  LeftMotor->setSpeed(125);
  }


}