#include<Servo.h>
//Declare the Servo pin
int servoPin=3;
//Create a servo object
Servo Servo1;
//defines pins numbers
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); // Sets the trigPin on HIGH state for 10 micro seconds
  delayMicroseconds(10);
  digitalWrite(trigPin, LOW);
// Reads the echoPin, returns the sound wave travel time in microseconds
  duration = pulseIn(echoPin, HIGH);
  distance= duration *0.034/2; // Calculating the distance
  Serial.print("Distance: "); // Prints the distance on the Serial Monitor
  Serial.println(distance);
  if(distance<6){
    Servo1.write(0);
  }
  else if(distance>=6){
    Servo1.write(180);
  }
}