Box Sketch

Box Sketch

int mot1up = 13; 

int mot1down = 12; 

int mot2right = 11; 

int mot2left = 10; 

// the setup routine runs once when you press reset: 

void setup() { 

// initialize the digital pin as an output.led right, led2 left, led3 up, led4 down: 

pinMode(mot1up, OUTPUT); 

pinMode(mot1down, OUTPUT); 

pinMode(mot2right, OUTPUT); 

pinMode(mot2left, OUTPUT);  } 

// the loop routine runs over and over again forever: 

void loop() { 

digitalWrite(mot1up, HIGH);     // (HIGH to motor 1 up) 

delay(500); // wait for .5 second 

digitalWrite(mot1up, LOW);      // turn off motor 

delay(500); //wait .5 seconds 

digitalWrite(mot2right, HIGH);   //go right 

delay(500); //keep going .5 second 

digitalWrite(mot2right, LOW); //turn off motor 

delay(500); //wait .5 seconds 

digitalWrite(mot1down, HIGH); //go down 

delay(500); //wait ,5 sec 

digitalWrite(mot1down, LOW); 

delay(500); 

digitalWrite(mot2left, HIGH); //go left 

delay(500); 

digitalWrite(mot2left, LOW); 

delay(500); //box finished 

///Now start second box at top of original 

digitalWrite(mot1up, HIGH);   // (HIGH to motor 1 up) 

delay(500); // wait for .5 second 

digitalWrite(mot1up, LOW); // turn off motor 

delay(500); //wait .5 seconds 

//45 angle right 

digitalWrite(mot1up, HIGH);       //go up again 

digitalWrite(mot2right, HIGH);   //and go right at same time 

delay(250); 

digitalWrite(mot1up, LOW); 

digitalWrite(mot2right, LOW); 

delay(500); 

digitalWrite(mot2right, HIGH); //go right 

delay(500); 

digitalWrite(mot2right, LOW); 

digitalWrite(mot1down, HIGH); //go down 

delay(500); //wait ,5 sec 

digitalWrite(mot1down, LOW); 

delay(500); 

//angle back at 45 degrees 

digitalWrite(mot1down, HIGH); //go down 

digitalWrite(mot2left, HIGH); //and left 

delay(250); 

digitalWrite(mot1down, LOW); 

digitalWrite(mot2left, LOW); 

delay(500); 

digitalWrite(mot1up, HIGH); //go up 

delay(500); 

digitalWrite(mot1up, LOW); 

delay(500); 

//finally go up right at 45 

digitalWrite(mot1up, HIGH); 

digitalWrite(mot2right, HIGH); 

delay(250); 

digitalWrite(mot1up, LOW); 

digitalWrite(mot2right, LOW); 

delay(500); 

delay(5000); 

// wait for a second  }