Banksy Bot Code

1
Banksy Bot Code /*--------------------------------------------------- BANKSY BOT CODE (8-dec-14) ---------------------------------------------------*/ // constants #define WATCHLED 12 // LED is pin 12 #define STARTBUTTON 13 // start button is pin 13 // variables int i; boolean startbutton; void setup() // run once, when program starts { pinMode(12, OUTPUT); // sets the LED pin as output pinMode(13,INPUT); //Switch as input pinMode(3,OUTPUT); //Lift Motor pinMode(8,OUTPUT); //Relay 1 pinMode(5, OUTPUT); //Torque Motor pinMode(6, OUTPUT); //Relay 2 } void loop() { startbutton=false; //-------------Watchdog code while (! startbutton) { // stay in this loop until button pressed digitalWrite(12, HIGH); // LED on for(i=0;i<10;i++) { delay(25); // wait a bit if (digitalRead(13) == LOW) // check button startbutton=true; // button is pressed } digitalWrite(12,LOW); // LED off for(i=0;i<30;i++) { delay(25); if (digitalRead(13) == LOW) startbutton=true; } } // end of while loop digitalWrite(12,LOW); // LED off robotcode(); // go to your robot code } // return to top void robotcode() { delay(2000); digitalWrite(3,HIGH); //motor on delay(6500); digitalWrite(3,LOW); //motor off digitalWrite(5,HIGH); //motor on delay(5000); digitalWrite(5,LOW); //motor off delay(5000); //wait for spikes to dissipate digitalWrite(8,HIGH); //reverse direction digitalWrite(6,HIGH); //reverse direction digitalWrite(5,HIGH); //motor on delay(5000); digitalWrite(3,LOW); //motor off digitalWrite(5,LOW); //motor off delay(10); //wait for spikes to dissipate digitalWrite(8,LOW); //relay off digitalWrite(6,LOW); //relay off }

Transcript of Banksy Bot Code

Page 1: Banksy Bot Code

Banksy Bot Code /*--------------------------------------------------- BANKSY BOT CODE (8-dec-14) ---------------------------------------------------*/ // constants #define WATCHLED 12 // LED is pin 12 #define STARTBUTTON 13 // start button is pin 13 // variables int i; boolean startbutton; void setup() // run once, when program starts { pinMode(12, OUTPUT); // sets the LED pin as output pinMode(13,INPUT); //Switch as input pinMode(3,OUTPUT); //Lift Motor pinMode(8,OUTPUT); //Relay 1 pinMode(5, OUTPUT); //Torque Motor pinMode(6, OUTPUT); //Relay 2 } void loop() { startbutton=false; //-------------Watchdog code while (! startbutton) { // stay in this loop until button pressed digitalWrite(12, HIGH); // LED on for(i=0;i<10;i++) { delay(25); // wait a bit if (digitalRead(13) == LOW) // check button startbutton=true; // button is pressed } digitalWrite(12,LOW); // LED off for(i=0;i<30;i++) { delay(25); if (digitalRead(13) == LOW) startbutton=true; } } // end of while loop digitalWrite(12,LOW); // LED off robotcode(); // go to your robot code } // return to top void robotcode() { delay(2000); digitalWrite(3,HIGH); //motor on delay(6500); digitalWrite(3,LOW); //motor off digitalWrite(5,HIGH); //motor on delay(5000); digitalWrite(5,LOW); //motor off delay(5000); //wait for spikes to dissipate digitalWrite(8,HIGH); //reverse direction digitalWrite(6,HIGH); //reverse direction digitalWrite(5,HIGH); //motor on delay(5000); digitalWrite(3,LOW); //motor off digitalWrite(5,LOW); //motor off delay(10); //wait for spikes to dissipate digitalWrite(8,LOW); //relay off digitalWrite(6,LOW); //relay off }