//Grobsbin Caleb Matute
#include <LiquidCrystal.h>
#include <Servo.h>
Servo miServo;

int LED = 10;
const int trigPin = 6;
const int echoPin = 7;

long duracion; 
float distancia;


LiquidCrystal lcd(12,11,5,4,3,2);


void setup() {
  lcd.begin(16,2);
  pinMode(LED, OUTPUT);
  pinMode(trigPin, OUTPUT);
  pinMode(echoPin, INPUT);
  miServo.attach(9);
}

void loop() {

  digitalWrite(trigPin, LOW);
  delayMicroseconds(2);

  digitalWrite(trigPin, HIGH);
  delayMicroseconds(10);

  digitalWrite(trigPin, LOW);

  duracion = pulseIn(echoPin, HIGH);

  distancia = duracion * 0.034 / 2;

    if(distancia < 15)
    {
      for(int angulo = 0; angulo <= 90; angulo++)
        {
          miServo.write(angulo);
          delay(10);
        }
      digitalWrite(LED, HIGH);
      lcd.setCursor(0,0);
      lcd.print("Acceso Permitido");
      delay(3000);
      lcd.setCursor(0,0);
      lcd.print("--------------------");
      digitalWrite(LED, LOW);
      for (int angulo = 90; angulo >= 0; angulo--)
      {
          miServo.write(angulo);
          delay(15);
      }
      
      delay(3000);
    }
    else 
    {
        lcd.setCursor(0,0);
        miServo.write(0);
        lcd.print("Esperando Usuario");
    }
    
   
    
    
    


}