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 }