Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- #define m11 2
- #define m12 3
- #define m21 4
- #define m22 5
- #define D0 8
- #define D1 9
- #define D2 10
- #define D3 11
- void forward()
- {
- digitalWrite(11,HIGH);
- digitalWrite(10,LOW);
- digitalWrite(9,HIGH);
- digitalWrite(8,LOW);
- }
- void back()
- {
- digitalWrite(11,LOW);
- digitalWrite(10,HIGH);
- digitalWrite(9,LOW);
- digitalWrite(8,HIGH);
- }
- void left()
- {
- digitalWrite(11,HIGH);
- digitalWrite(10,LOW);
- digitalWrite(9,LOW);
- digitalWrite(8,LOW);
- }
- void right()
- {
- digitalWrite(11,LOW);
- digitalWrite(10,LOW);
- digitalWrite(9,HIGH);
- digitalWrite(8,LOW);
- }
- void stop()
- {
- digitalWrite(11,LOW);
- digitalWrite(10,LOW);
- digitalWrite(9,LOW);
- digitalWrite(8,LOW);
- }
- void setup() {
- pinMode(D0,INPUT);
- pinMode(D1,INPUT);
- pinMode(D2,INPUT);
- pinMode(D3,INPUT);
- pinMode(m11,OUTPUT);
- pinMode(m12,OUTPUT);
- pinMode(m21,OUTPUT);
- pinMode(m22,OUTPUT);
- }
- void loop() {
- int temp1=digitalRead(D0);
- int temp2=digitalRead(D1);
- int temp3=digitalRead(D2);
- int temp4=digitalRead(D3);
- if(temp1==0 && temp2==1 && temp3==0&& temp4==0)
- forward();
- if(temp1==0 && temp2==0 && temp3==0 && temp4==1)
- back();
- if(temp1==0 && temp2==0 && temp3==1 && temp4==0)
- left();
- if(temp1==0 && temp2==1 && temp3==1 && temp4==0)
- right();
- if(temp1==1 && temp2==0 && temp3==1 && temp4==0)
- stop();
- }
Add Comment
Please, Sign In to add comment