Lego Robot

1int data;
2
3#define E1 6  // Enable Pin for motor 1
4#define E2
5  9  // Enable Pin for motor 2
6
7#define I1 4  // Control pin 1 for motor 1
8#define
9  I2 5  // Control pin 2 for motor 1
10#define I3 8  // Control pin 1 for motor 2
11#define
12  I4 7  // Control pin 2 for motor 2
13
14
15void setup() 
16{
17 Serial.begin(9600);
18  
19//silnik 1
20pinMode(12,OUTPUT);
21//silnik 2
22pinMode(13,OUTPUT);
23//reszta
24pinMode(2,OUTPUT);
25//głowa
26  powieki
27    pinMode(E1, OUTPUT); // speed engine 1
28    pinMode(E2, OUTPUT);
29  // speed engine 2
30    pinMode(I1, OUTPUT);
31    pinMode(I2, OUTPUT);
32    pinMode(I3,
33  OUTPUT);
34    pinMode(I4, OUTPUT);
35}
36
37void loop() 
38{
39 data=Serial.read();
40
41  Serial.println(data);
42 delay(200);
43 
44 if(data==5)
45 {
46    digitalWrite(12,LOW);
47
48    digitalWrite(13,HIGH);
49    analogWrite(3,255);
50    analogWrite(11,255);
51
52  }
53
54if(data==6)
55{
56  
57  digitalWrite(12,LOW);
58  digitalWrite(13,HIGH);
59
60  analogWrite(3,0);
61  analogWrite(11,0);
62  
63}
64if(data==7)
65 {
66
67    digitalWrite(12,HIGH);
68    digitalWrite(13,LOW);
69    analogWrite(3,255);
70
71    analogWrite(11,255);
72}
73if(data==8)
74{
75  
76  digitalWrite(12,LOW);
77
78  digitalWrite(13,HIGH);
79  analogWrite(3,0);
80  analogWrite(11,0);
81}
82if(data==1)
83
84  {
85    digitalWrite(12,HIGH);
86    digitalWrite(13,HIGH);
87    analogWrite(3,255);
88
89    analogWrite(11,255);
90 }
91 if(data==2)
92{
93  
94  digitalWrite(12,LOW);
95
96  digitalWrite(13,HIGH);
97  analogWrite(3,0);
98  analogWrite(11,0);
99}
100if(data==3)
101
102  {
103    digitalWrite(12,LOW);
104    digitalWrite(13,LOW);
105    analogWrite(3,255);
106
107    analogWrite(11,255);
108 }
109 if(data==4)
110{
111  
112  digitalWrite(12,LOW);
113
114  digitalWrite(13,HIGH);
115  analogWrite(3,0);
116  analogWrite(11,0);
117}
118
119if(data==14)
120{
121
122  digitalWrite(2,HIGH);
123}
124if(data==15)
125{
126  digitalWrite(2,LOW);
127}
128if(data==18)
129{
130analogWrite(E2,
131  255);
132digitalWrite(I3, HIGH);
133digitalWrite(I4, LOW);
134}
135if(data==19)
136{
137analogWrite(E2,
138  LOW);
139}
140
141if(data==20)
142{
143analogWrite(E2, 255);
144digitalWrite(I3,
145  LOW);
146digitalWrite(I4, HIGH);
147}
148if(data==21)
149{
150analogWrite(E2, LOW);
151}
152
153if(data==16)
154{
155analogWrite(E1,
156  255);
157digitalWrite(I1, HIGH);
158digitalWrite(I2, LOW);
159delay(100);
160analogWrite(E1,LOW);
161}
162if(data==17)
163{
164analogWrite(E1,
165  255);
166digitalWrite(I1, LOW);
167digitalWrite(I2, HIGH);
168delay(100);
169analogWrite(E1,LOW);
170}
171}

1int data;
2
3#define E1 6  // Enable Pin for motor 1
4#define E2  9  // Enable Pin for motor 2
5
6#define I1 4  // Control pin 1 for motor 1
7#define  I2 5  // Control pin 2 for motor 1
8#define I3 8  // Control pin 1 for motor 2
9#define  I4 7  // Control pin 2 for motor 2
10
11
12void setup() 
13{
14 Serial.begin(9600);  
15//silnik 1
16pinMode(12,OUTPUT);
17//silnik 2
18pinMode(13,OUTPUT);
19//reszta
20pinMode(2,OUTPUT);
21//głowa  powieki
22    pinMode(E1, OUTPUT); // speed engine 1
23    pinMode(E2, OUTPUT);  // speed engine 2
24    pinMode(I1, OUTPUT);
25    pinMode(I2, OUTPUT);
26    pinMode(I3,  OUTPUT);
27    pinMode(I4, OUTPUT);
28}
29
30void loop() 
31{
32 data=Serial.read();
33  Serial.println(data);
34 delay(200);
35 
36 if(data==5)
37 {
38    digitalWrite(12,LOW);
39    digitalWrite(13,HIGH);
40    analogWrite(3,255);
41    analogWrite(11,255);
42  }
43
44if(data==6)
45{
46  
47  digitalWrite(12,LOW);
48  digitalWrite(13,HIGH);
49  analogWrite(3,0);
50  analogWrite(11,0);
51  
52}
53if(data==7)
54 {
55    digitalWrite(12,HIGH);
56    digitalWrite(13,LOW);
57    analogWrite(3,255);
58    analogWrite(11,255);
59}
60if(data==8)
61{
62  
63  digitalWrite(12,LOW);
64  digitalWrite(13,HIGH);
65  analogWrite(3,0);
66  analogWrite(11,0);
67}
68if(data==1)
69  {
70    digitalWrite(12,HIGH);
71    digitalWrite(13,HIGH);
72    analogWrite(3,255);
73    analogWrite(11,255);
74 }
75 if(data==2)
76{
77  
78  digitalWrite(12,LOW);
79  digitalWrite(13,HIGH);
80  analogWrite(3,0);
81  analogWrite(11,0);
82}
83if(data==3)
84  {
85    digitalWrite(12,LOW);
86    digitalWrite(13,LOW);
87    analogWrite(3,255);
88    analogWrite(11,255);
89 }
90 if(data==4)
91{
92  
93  digitalWrite(12,LOW);
94  digitalWrite(13,HIGH);
95  analogWrite(3,0);
96  analogWrite(11,0);
97}
98
99if(data==14)
100{
101  digitalWrite(2,HIGH);
102}
103if(data==15)
104{
105  digitalWrite(2,LOW);
106}
107if(data==18)
108{
109analogWrite(E2,  255);
110digitalWrite(I3, HIGH);
111digitalWrite(I4, LOW);
112}
113if(data==19)
114{
115analogWrite(E2,  LOW);
116}
117
118if(data==20)
119{
120analogWrite(E2, 255);
121digitalWrite(I3,  LOW);
122digitalWrite(I4, HIGH);
123}
124if(data==21)
125{
126analogWrite(E2, LOW);
127}
128
129if(data==16)
130{
131analogWrite(E1,  255);
132digitalWrite(I1, HIGH);
133digitalWrite(I2, LOW);
134delay(100);
135analogWrite(E1,LOW);
136}
137if(data==17)
138{
139analogWrite(E1,  255);
140digitalWrite(I1, LOW);
141digitalWrite(I2, HIGH);
142delay(100);
143analogWrite(E1,LOW);
144}
145}