#include <Servo.h>
Servo myservo;


#define PIN_TRIG 12
#define PIN_ECHO 11
#define PIN_LED 13
void setup() {
  // put your setup code here, to run once:
 Serial.begin(115200);
  pinMode(PIN_TRIG, OUTPUT);
  pinMode(PIN_ECHO, INPUT);
  pinMode(PIN_LED, OUTPUT);
  myservo.attach(10);
}

void loop() {
  // put your main code here, to run repeatedly:
  digitalWrite(PIN_TRIG, HIGH);
  delayMicroseconds(10);
  digitalWrite(PIN_TRIG, LOW);
  delayMicroseconds(10);
  digitalWrite(PIN_TRIG, HIGH);
  long Duration = pulseIn(PIN_ECHO, HIGH);
  float distance = Duration * 0.034 / 2;
  Serial.print("Distance in CM: ");
  Serial.println(Duration / 60);
  
 
  
  if (distance <= 4) {
    digitalWrite(PIN_LED, HIGH);  
    myservo.write(90);            
  } else {
    digitalWrite(PIN_LED, LOW);   
    myservo.write(0);             
  }
  delay(1000);
 
 
  
}