#include #include #define trigPin 11 #define echoPin 12 #define MAX_DISTANCE 500 NewPing sonar(trigPin, echoPin, MAX_DISTANCE); //int pos = 20; Servo myservo1; Servo myservo2; void setup() { Serial.begin (115200); pinMode(trigPin, OUTPUT); pinMode(echoPin, INPUT); myservo1.attach(9); myservo2.attach(10); } void loop() { digitalWrite(8,HIGH); int duration, distance,pos=0,i; digitalWrite(trigPin, LOW); delayMicroseconds(2); digitalWrite(trigPin, HIGH); delayMicroseconds(10); digitalWrite(trigPin, LOW); duration = pulseIn(echoPin, HIGH); distance = (duration/2) / 29.1; Serial.print(distance); Serial.println(" cm"); if(distance<=15) { myservo1.write(180); myservo2.write(180); } else{ myservo1.write(0); myservo2.write(180); } delay(450); }