1
5
6#define LS 2
7#define RS 3
8#define LM1 5
9#define LM2 4
10#define RM1 7
11#define RM2 6
12void setup()
13{
14pinMode(LS, INPUT);
15pinMode(RS, INPUT);
16pinMode(LM1, OUTPUT);
17pinMode(LM2, OUTPUT);
18pinMode(RM1, OUTPUT);
19pinMode(RM2, OUTPUT);
20}
21void loop()
22{
23if(digitalRead(LS) && digitalRead(RS))
24{
25digitalWrite(LM1, HIGH);
26digitalWrite(LM2, LOW);
27digitalWrite(RM1, HIGH);
28digitalWrite(RM2, LOW);
29}
30if(digitalRead(LS) && !(digitalRead(RS)))
31{
32digitalWrite(LM1, HIGH);
33digitalWrite(LM2, LOW);
34digitalWrite(RM1, LOW);
35digitalWrite(RM2, HIGH);
36}
37if(!(digitalRead(LS)) && digitalRead(RS))
38{
39digitalWrite(LM1, LOW);
40digitalWrite(LM2, HIGH);
41digitalWrite(RM1, HIGH);
42digitalWrite(RM2, LOW);
43}
44
45if(!(digitalRead(LS)) && !(digitalRead(RS)))
46{
47digitalWrite(LM1, LOW);
48digitalWrite(LM2, LOW);
49digitalWrite(RM1, LOW);
50digitalWrite(RM2, LOW);
51}
52}