#include <Servo.h>
const int trigPin = 10;  // Trigger pin
const int echoPin = 9;  // Echo pin
const int servoPin = 11;  // Servo motor pin
Servo myServo;  
void setup() {
  Serial.begin(9600);
  pinMode(trigPin, OUTPUT);
  pinMode(echoPin, INPUT);
  pinMode(5,OUTPUT);//led1 
  myServo.attach(servoPin); 
}
void loop() {
  long duration, distance;
  digitalWrite(trigPin, LOW); 
  delayMicroseconds(2);
  digitalWrite(trigPin, HIGH); 
  delayMicroseconds(10);
  digitalWrite(trigPin, LOW);
  duration = pulseIn(echoPin, HIGH);
  distance = (duration / 2) * 0.034;  
   if (distance < 40) {
    myServo.write(90); 
    digitalWrite(5, HIGH); 
  }
  Serial.print("Distance: ");
  Serial.print(distance);
  Serial.println(" cm");
  delay(500);
}