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
#define L 2
#define C 3
#define R 4
void setup() {
Serial.begin(9600);
pinMode(L, INPUT);
pinMode(C, INPUT);
pinMode(R, INPUT);
}
void loop() {
bool left = digitalRead(L);
bool center = digitalRead(C);
bool right = digitalRead(R);
if (left == 1 && center == 0 && right == 1) {
Serial.print("**Forward**");
Serial.println();
} else if (left == 0 && center == 0 && right == 0) {
Serial.print("**Stop**");
Serial.println();
} else if (left == 1 && center == 1 && right == 1) {
Serial.print("**Stop**");
Serial.println();
} else if (left == 0 && center == 0 && right == 1) {
Serial.print("**Turn Left**");
Serial.println();
} else if (left == 1 && center == 0 && right == 0) {
Serial.print("**Turn Right**");
Serial.println();
} else if (left == 0 && center == 1 && right == 1) {
Serial.print("**Turn Left**");
Serial.println();
} else if (left == 1 && center == 1 && right == 0) {
Serial.print("**Turn Right**");
Serial.println();
}
Serial.print("left = ");
Serial.print(left);
Serial.print(" center = ");
Serial.print(center);
Serial.print(" right = ");
Serial.print(right);
Serial.println("
");
}