#include <Servo.h>
#define trigPin 7
#define echoPin 6
#define led 13
#define led2 12
#define led3 11
Servo door1;


void setup() {
  Serial.begin (9600);
  pinMode(trigPin, OUTPUT);
  pinMode(echoPin, INPUT);
  pinMode(led, OUTPUT);
  pinMode(led2, OUTPUT);
  pinMode(led3, OUTPUT);
  door1.attach(10);
}

void loop() {
  long duration, distance;
  digitalWrite(trigPin, LOW);
  delayMicroseconds(2);
  digitalWrite(trigPin, HIGH);
  delayMicroseconds(10);
  digitalWrite(trigPin, LOW);
  duration = pulseIn(echoPin, HIGH);
  distance = 0.03435 * (duration / 2);
  if (distance > 100) {
    digitalWrite(led,HIGH);
    digitalWrite(led2,LOW);
    digitalWrite(led3,LOW);
    door1.write(90);
  }
  else if (distance < 101 && distance > 50) {
    digitalWrite(led,LOW);
    digitalWrite(led2,HIGH);
    digitalWrite(led3,LOW);
  }
  else {
    digitalWrite(led,LOW);
    digitalWrite(led2,LOW);
    digitalWrite(led3,HIGH);
    door1.write(0);
  }
    Serial.print(distance);
    Serial.println(" cm");
  delay(500);
}