#include<Servo.h>
byte ServoPin = 5;
Servo Servo1;
byte TrigPin = 9;
byte EchoPin = 8;
long Duration;
int Distance;
void setup(){
Servo1.attach(ServoPin);
pinMode(TrigPin, OUTPUT);
pinMode(EchoPin, INPUT);
Serial.begin(9600);
}

void loop() {
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){
Servo1.write(0);
}
else{
Servo1.write(180);
}
}