#include <Servo.h>
#include <NewPing.h>
#define TRIGGER 8
#define ECHO 7
#define MAXDIST 400
NewPing sonar(TRIGGER, ECHO, MAXDIST);
Servo ser1;
Servo ser2;
Servo ser3;
Servo ser4;
Servo ser5;
Servo ser6;
void setup() {
// put your setup code here, to run once:
ser1.attach(1);
ser2.attach(2);
ser3.attach(3);
ser4.attach(4);
ser5.attach(5);
ser6.attach(6);
ser1.write(90);
ser2.write(90);
ser3.write(90);
ser4.write(90);
ser5.write(90);
ser6.write(90);
}
void loop() {
// put your main code here, to run repeatedly:
unsigned int distanceCM = sonar.ping_cm();
delay(2000);
ser6.write(150);
delay(1000);
if(distanceCM < 20){
ser6.write(90);
if (distanceCM > 10);{
ser1.write(150);
ser2.write(20);
ser3.write(150);
ser4.write(20);
delay(100);
ser1.write(90);
ser2.write(90);
ser3.write(90);
ser4.write(90);
delay(100);
ser1.write(20);
ser2.write(150);
ser3.write(20);
ser4.write(150);
delay(100);
ser1.write(90);
ser2.write(90);
ser3.write(90);
ser4.write(90);
delay(100);
ser1.write(150);
ser2.write(20);
ser3.write(150);
ser4.write(20);
delay(100);
ser1.write(90);
ser2.write(90);
ser3.write(90);
ser4.write(90);
delay(100);
ser1.write(20);
ser2.write(150);
ser3.write(20);
ser4.write(150);
delay(100);
ser1.write(90);
ser2.write(90);
ser3.write(90);
ser4.write(90);
delay(100);
ser1.write(150);
ser2.write(20);
ser3.write(150);
ser4.write(20);
delay(100);
ser1.write(90);
ser2.write(90);
ser3.write(90);
ser4.write(90);
delay(100);
ser1.write(20);
ser2.write(150);
ser3.write(20);
ser4.write(150);
delay(100);
ser1.write(90);
ser2.write(90);
ser3.write(90);
ser4.write(90);
delay(100);
ser1.write(150);
ser2.write(20);
ser3.write(150);
ser4.write(20);
delay(100);
ser1.write(90);
ser2.write(90);
ser3.write(90);
ser4.write(90);
delay(100);
ser1.write(20);
ser2.write(150);
ser3.write(20);
ser4.write(150);
delay(100);
ser1.write(90);
ser2.write(90);
ser3.write(90);
ser4.write(90);
delay(100);
ser1.write(150);
ser2.write(20);
ser3.write(150);
ser4.write(20);
delay(100);
ser1.write(90);
ser2.write(90);
ser3.write(90);
ser4.write(90);
delay(100);
ser1.write(20);
ser2.write(150);
ser3.write(20);
ser4.write(150);
delay(100);
ser1.write(90);
ser2.write(90);
ser3.write(90);
ser4.write(90);
delay(100);
ser1.write(150);
ser2.write(20);
ser3.write(150);
ser4.write(20);
delay(100);
ser1.write(90);
ser2.write(90);
ser3.write(90);
ser4.write(90);
delay(100);
ser1.write(20);
ser2.write(150);
ser3.write(20);
ser4.write(150);
delay(100);
ser1.write(90);
ser2.write(90);
ser3.write(90);
ser4.write(90);
delay(100);
ser1.write(150);
ser2.write(20);
ser3.write(150);
ser4.write(20);
delay(100);
ser1.write(90);
ser2.write(90);
ser3.write(90);
ser4.write(90);
delay(100);
ser1.write(20);
ser2.write(150);
ser3.write(20);
ser4.write(150);
delay(100);
ser1.write(90);
ser2.write(90);
ser3.write(90);
ser4.write(90);
delay(100);
ser1.write(150);
ser2.write(20);
ser3.write(150);
ser4.write(40);
delay(100);
ser1.write(90);
ser2.write(90);
ser3.write(90);
ser4.write(90);
delay(100);
ser1.write(20);
ser2.write(150);
ser3.write(20);
ser4.write(150);
delay(100);
ser1.write(90);
ser2.write(90);
ser3.write(90);
ser4.write(90);
delay(100);
}
}
else{
ser6.write(90);
}
}
Comments
Please log in or sign up to comment.