-
Notifications
You must be signed in to change notification settings - Fork 0
/
Copy pathltr.ino
48 lines (47 loc) · 1014 Bytes
/
ltr.ino
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
int i1=0;
int i2=0;
int i3=0;
void right()
{digitalWrite(11,HIGH);
digitalWrite(12,LOW);
digitalWrite(7,HIGH);
digitalWrite(8,LOW);}
void left()
{digitalWrite(11,LOW);
digitalWrite(12,HIGH);
digitalWrite(7,LOW);
digitalWrite(8,HIGH);}
void fort()
{ digitalWrite(11,HIGH);
digitalWrite(12,LOW);
digitalWrite(7,LOW);
digitalWrite(8,HIGH); }
void setup(){
pinMode(2,INPUT);
pinMode(4,INPUT);
pinMode(3,INPUT);
pinMode(9,OUTPUT);
pinMode(10,OUTPUT);
pinMode(5,OUTPUT);
pinMode(6,OUTPUT);}
void loop()
{i1=digitalRead(2);
i2=digitalRead(3);
i3=digitalRead(4);
if (i1==LOW && i2==HIGH && i3==LOW)
{ fort(); }
else if (i1==LOW && i2==LOW && i3==HIGH)
{ right(); }
else if (i1==HIGH && i2==HIGH && i3==LOW)
{left(); }
else if (i1==LOW && i2==HIGH && i3==HIGH)
{ right(); }
else if (i1==HIGH && i2==LOW && i3==LOW)
{left(); }
else if (i1==LOW && i2==LOW && i3==LOW)
{digitalWrite(11,LOW);
digitalWrite(12,HIGH);
digitalWrite(7,HIGH);
digitalWrite(8,LOW);}
else if (i1==HIGH && i2==HIGH && i3==HIGH)
{ fort(); }}