// Adafruit Motor shield library


#include <AFMotor.h>
//AF_DCMotor motor(2, MOTOR12_64KHZ); // create motor #2, 64KHz pwm
//frequency is how fast the speed controlling signal is. 
//For motors 1 and 2 you can choose MOTOR12_64KHZ, MOTOR12_8KHZ, MOTOR12_2KHZ, or MOTOR12_1KHZ. 
//A high speed like 64KHz wont be audible but a low speed like 1KHz will use less power.


AF_DCMotor motorL(1, MOTOR12_8KHZ);
AF_DCMotor motorR(2, MOTOR12_8KHZ);
int ledPin = 14; //Backup LED
int ledPin2 = 15; //Backup LED
void setup() {
  Serial.begin(9600);
  pinMode(ledPin, OUTPUT);    
  pinMode(ledPin2, OUTPUT);   
  Serial.println("Motor test!");
  Serial.println("-----------");

  // turn on motor
  motorL.setSpeed(200);
  motorR.setSpeed(200);
 
  motorL.run(RELEASE);
  motorR.run(RELEASE);
}

void loop() {
  digitalWrite(ledPin, HIGH);
  digitalWrite(ledPin2, HIGH);
  
  uint8_t i;
   Serial.println("Left Forward ");
   motorL.run(FORWARD);
   delay(1500);
   motorL.run(RELEASE);
   Serial.println("Left Backward ");
   digitalWrite(ledPin, HIGH); 
   motorL.run(BACKWARD);
   delay(1500);
   digitalWrite(ledPin, LOW); 
   motorL.run(RELEASE);
   delay(2000);
   
   Serial.println("Right Forward ");
   motorR.run(FORWARD);
   delay(1500);
   motorR.run(RELEASE);
     digitalWrite(ledPin, HIGH);
   Serial.println("Right Backward ");
   motorR.run(BACKWARD);
   delay(1500);
   digitalWrite(ledPin, LOW); 
   motorR.run(RELEASE);
  delay(2000); 
	
  Serial.println("R & L Forwards ");
  motorL.run(FORWARD);
  motorR.run(FORWARD);
  delay(1000);
  
  motorL.run(RELEASE);
  motorR.run(RELEASE);
 
  Serial.println("R & L Backwards ");
  motorL.run(BACKWARD);
  motorR.run(BACKWARD);
  delay(1000);
  
  motorL.run(RELEASE);
  motorR.run(RELEASE);
  Serial.println("Test Complete! ");
  delay(2000);
  Serial.println("-------------- ");
  delay(500);

}