#include <AFMotor.h>

AF_DCMotor motor1(1);
AF_DCMotor motor2(2);
AF_DCMotor motor3(3);
AF_DCMotor motor4(4);

void setup() {
  Serial.begin(9600);           // set up Serial library at 9600 bps
  Serial.println("Motor test!");
  
  motor1.setSpeed(255);  // Full PWM (speed)
  motor2.setSpeed(255);
  motor3.setSpeed(255);
  motor4.setSpeed(255);
}

void loop() {
  Serial.println("start test cycle");
   
  motor1.run(FORWARD);      // Forward
  motor2.run(FORWARD);     
  motor3.run(FORWARD);      
  motor4.run(FORWARD);     
  delay(1000);


  motor1.run(RELEASE);      // stopped
  motor2.run(RELEASE);      
  motor3.run(RELEASE);      
  motor4.run(RELEASE);      
  delay(1000);
  
  Serial.print("tock");
  motor1.run(BACKWARD);     // Backward
  motor2.run(BACKWARD);      
  motor3.run(BACKWARD);     
  motor4.run(BACKWARD);     
  delay(1000);
  
  motor1.run(RELEASE);      // stopped
  motor2.run(RELEASE);      
  motor3.run(RELEASE);      
  motor4.run(RELEASE);      
  delay(1000);

  motor1.run(BACKWARD);     // Left
  motor2.run(FORWARD);     
  motor3.run(BACKWARD);    
  motor4.run(FORWARD);     
  delay(1000);

  motor1.run(RELEASE);      // stopped
  motor2.run(RELEASE);      
  motor3.run(RELEASE);      
  motor4.run(RELEASE);      
  delay(1000);

  motor1.run(FORWARD);     // Right
  motor2.run(BACKWARD);
  motor3.run(FORWARD);   
  motor4.run(BACKWARD);   
  delay(1000);
  
  motor1.run(RELEASE);      // stopped
  motor2.run(RELEASE);      
  motor3.run(RELEASE);      
  motor4.run(RELEASE);      
  delay(1000);
}