Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- //Pins for motor A1,2
- const int MotorA1 = 6;
- const int MotorA2 = 7;
- //Pins for motor B1,2
- const int MotorB1 = 8;
- const int MotorB2 = 9;
- void setup() {
- pinMode(MotorA1, OUTPUT);
- pinMode(MotorA2, OUTPUT);
- pinMode(MotorB1, OUTPUT);
- pinMode(MotorB2, OUTPUT);
- }
- void go(){
- digitalWrite (MotorA1, HIGH);
- digitalWrite (MotorA2, LOW);
- digitalWrite (MotorB1, HIGH);
- digitalWrite (MotorB2, LOW);
- }
- void backwards(){
- digitalWrite (MotorA1 , LOW);
- digitalWrite (MotorA2, HIGH);
- digitalWrite (MotorB1, LOW);
- digitalWrite (MotorB2, HIGH);
- }
- void turnleft(int t){
- digitalWrite (MotorA1, LOW);
- digitalWrite (MotorA2, HIGH);
- digitalWrite (MotorB1, HIGH);
- digitalWrite (MotorB2, LOW);
- delay(t);
- }
- void turnright(int t){
- digitalWrite (MotorA1, HIGH);
- digitalWrite (MotorA2, LOW);
- digitalWrite (MotorB1, LOW);
- digitalWrite (MotorB2, HIGH);
- delay(t);
- }
- void stopmove(){
- digitalWrite (MotorA1 ,LOW);
- digitalWrite (MotorA2, LOW);
- digitalWrite (MotorB1, LOW);
- digitalWrite (MotorB2, LOW);
- }
- void loop() {
- // put your main code here, to run repeatedly:
- go;
- delay(10000);
- backwards;
- delay (10000);
- turnleft;
- delay(1500);
- turnright;
- delay(1500);
- stopmove;
- delay (100000);
- }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement