// the setup function runs once when you press reset or power the board
#define LED              13
#define MOTOR_ENABLE	  9

#define MOTOR_M1	  7
#define MOTOR_M0	  6 
#define MOTOR_DIR_R       5
#define MOTOR_CLK_R	  4
#define MOTOR_DIR_L       3
#define MOTOR_CLK_L	  2

void setup() {
  // initialize digital pin 13 as an output.
  pinMode(LED, OUTPUT);
  pinMode(MOTOR_CLK_L, OUTPUT);
  pinMode(MOTOR_DIR_L, OUTPUT);
  pinMode(MOTOR_CLK_R, OUTPUT);
  pinMode(MOTOR_DIR_R, OUTPUT);
  pinMode(MOTOR_M0, OUTPUT);
  pinMode(MOTOR_M1, OUTPUT);
  pinMode(MOTOR_ENABLE, OUTPUT);  
  Serial.begin(9600); 
  while (!Serial) {
    ; // wait for serial port to connect. Needed for Leonardo only
  }  
  // prints title with ending line break 
  Serial.println("Testing AM-MS2 with U-Style(Arduino at heart)");
}

// the loop function runs over and over again forever
void loop() {
  digitalWrite(MOTOR_ENABLE, HIGH);       // Motor Enable as HIGH
  digitalWrite(MOTOR_M1, LOW);            // Motor M2 as LOW
  digitalWrite(MOTOR_M0, LOW);            // Motor M1 as LOW  sixteenth mode
  digitalWrite(MOTOR_DIR_R, HIGH);         // Motor DIR_R as CW (LOW)
  digitalWrite(MOTOR_DIR_L, LOW);         // Motor DIR_L as CW (LOW)
  
  while(1){
      digitalWrite(MOTOR_CLK_L, LOW);     // Motor CLK_L as LOW    
      digitalWrite(MOTOR_CLK_R, LOW);     // Motor CLK_R as LOW          
      _delay_us(50);                          // wait for a second
      digitalWrite(MOTOR_CLK_L, HIGH);    // Motor CLK_L as HIGH     
      digitalWrite(MOTOR_CLK_R, HIGH);    // Motor CLK_R as HIGH 
      _delay_us(50);                          // wait for a second
      //Serial.print("."); 
      // Motor_CLK_L pulse
  }  
}