Dog Robot 1.0

1#include <Servo.h>
2#include <NewPing.h>
3#define TRIGGER 8
4#define  ECHO 7
5#define MAXDIST 400
6NewPing sonar(TRIGGER, ECHO, MAXDIST);
7Servo  ser1;
8Servo ser2;
9Servo ser3;
10Servo ser4;
11Servo ser5;
12Servo ser6;
13void  setup() {
14  // put your setup code here, to run once:
15ser1.attach(1);
16ser2.attach(2);
17ser3.attach(3);
18ser4.attach(4);
19ser5.attach(5);
20ser6.attach(6);
21ser1.write(90);
22ser2.write(90);
23ser3.write(90);
24ser4.write(90);
25ser5.write(90);
26ser6.write(90);
27  
28}
29
30void loop() {
31  // put your main code here, to run repeatedly:
32unsigned  int distanceCM = sonar.ping_cm();
33delay(2000);
34ser6.write(150);
35delay(1000);
36if(distanceCM  < 20){
37  ser6.write(90);
38
39  if (distanceCM > 10);{
40    ser1.write(150);
41    ser2.write(20);
42    ser3.write(150);
43    ser4.write(20);
44    delay(100);
45    ser1.write(90);
46    ser2.write(90);
47    ser3.write(90);
48    ser4.write(90);
49    delay(100);
50    ser1.write(20);
51    ser2.write(150);
52    ser3.write(20);
53    ser4.write(150);
54    delay(100);
55    ser1.write(90);
56    ser2.write(90);
57    ser3.write(90);
58    ser4.write(90);
59    delay(100);  
60        ser1.write(150);
61    ser2.write(20);
62    ser3.write(150);
63    ser4.write(20);
64    delay(100);
65    ser1.write(90);
66    ser2.write(90);
67    ser3.write(90);
68    ser4.write(90);
69    delay(100);
70    ser1.write(20);
71    ser2.write(150);
72    ser3.write(20);
73    ser4.write(150);
74    delay(100);
75    ser1.write(90);
76    ser2.write(90);
77    ser3.write(90);
78    ser4.write(90);
79    delay(100);  
80        ser1.write(150);
81    ser2.write(20);
82    ser3.write(150);
83    ser4.write(20);
84    delay(100);
85    ser1.write(90);
86    ser2.write(90);
87    ser3.write(90);
88    ser4.write(90);
89    delay(100);
90    ser1.write(20);
91    ser2.write(150);
92    ser3.write(20);
93    ser4.write(150);
94    delay(100);
95    ser1.write(90);
96    ser2.write(90);
97    ser3.write(90);
98    ser4.write(90);
99    delay(100);  
100        ser1.write(150);
101    ser2.write(20);
102    ser3.write(150);
103    ser4.write(20);
104    delay(100);
105    ser1.write(90);
106    ser2.write(90);
107    ser3.write(90);
108    ser4.write(90);
109    delay(100);
110    ser1.write(20);
111    ser2.write(150);
112    ser3.write(20);
113    ser4.write(150);
114    delay(100);
115    ser1.write(90);
116    ser2.write(90);
117    ser3.write(90);
118    ser4.write(90);
119    delay(100);  
120        ser1.write(150);
121    ser2.write(20);
122    ser3.write(150);
123    ser4.write(20);
124    delay(100);
125    ser1.write(90);
126    ser2.write(90);
127    ser3.write(90);
128    ser4.write(90);
129    delay(100);
130    ser1.write(20);
131    ser2.write(150);
132    ser3.write(20);
133    ser4.write(150);
134    delay(100);
135    ser1.write(90);
136    ser2.write(90);
137    ser3.write(90);
138    ser4.write(90);
139    delay(100);  
140        ser1.write(150);
141    ser2.write(20);
142    ser3.write(150);
143    ser4.write(20);
144    delay(100);
145    ser1.write(90);
146    ser2.write(90);
147    ser3.write(90);
148    ser4.write(90);
149    delay(100);
150    ser1.write(20);
151    ser2.write(150);
152    ser3.write(20);
153    ser4.write(150);
154    delay(100);
155    ser1.write(90);
156    ser2.write(90);
157    ser3.write(90);
158    ser4.write(90);
159    delay(100);  
160        ser1.write(150);
161    ser2.write(20);
162    ser3.write(150);
163    ser4.write(20);
164    delay(100);
165    ser1.write(90);
166    ser2.write(90);
167    ser3.write(90);
168    ser4.write(90);
169    delay(100);
170    ser1.write(20);
171    ser2.write(150);
172    ser3.write(20);
173    ser4.write(150);
174    delay(100);
175    ser1.write(90);
176    ser2.write(90);
177    ser3.write(90);
178    ser4.write(90);
179    delay(100);  
180        ser1.write(150);
181    ser2.write(20);
182    ser3.write(150);
183    ser4.write(40);
184    delay(100);
185    ser1.write(90);
186    ser2.write(90);
187    ser3.write(90);
188    ser4.write(90);
189    delay(100);
190    ser1.write(20);
191    ser2.write(150);
192    ser3.write(20);
193    ser4.write(150);
194    delay(100);
195    ser1.write(90);
196    ser2.write(90);
197    ser3.write(90);
198    ser4.write(90);
199    delay(100);  
200  }
201 
202}
203  else{
204    ser6.write(90);
205
206  }
207}
208
209
210