#include <Servo.h>
int servoPin = 3;
Servo Servol;
const int trigPin = 9;
const int echoPin = 10;
long duration;
int distance;
void setup() {
Servol.attach(servoPin);
pinMode(trigPin, OUTPUT);
pinMode(echoPin, INPUT);
Serial.begin(9600);
}
void loop() {
//clears the trigPin
digitalWrite(trigPin, LOW);
delayMicroseconds(2);;
digitalWrite(trigPin, HIGH);
delayMicroseconds(10);;
digitalWrite(trigPin, LOW);
duration=pulseIn(echoPin,HIGH);
distance=duration*0.034/2;
Serial.print("Distance:");
Serial.println(distance);
if (distance<=6){
Servol.write(0);
}
else if (distance<=6){
Servol.write(180);
}
}