#include <Servo.h>

int servoPin = 3;

Servo Servo1;

const int trigPin = 9;
const int echoPin = 10;

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 if (distance>=6) {
  Servo1.write(180);
}

}