//Javier Enmanuel Argueta Osorio - 1501200402109
// Ejercicio 2 - Examen 1er parciall

#include <Servo.h>
Servo miServo;
int verde = 5;
const int trigPin = 9;
const int echoPin = 10;

long duracion;
float distancia;

void setup() {
  // put your setup code here, to run once:
  miServo.attach(8);
  Serial.begin(9600);
  pinMode(trigPin, OUTPUT);
  pinMode(echoPin, INPUT);
  pinMode(verde, OUTPUT);
  
}

void loop() {
  // put your main code here, to run repeatedly:
  digitalWrite(trigPin, LOW);
  delay(2);

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

  digitalWrite(trigPin, LOW);

  duracion = pulseIn(echoPin, HIGH);

  distancia = (duracion * 0.034) / 2;

  if(distancia < 15)
  {
    digitalWrite(verde, HIGH);
    for (int angulo = 0; angulo <= 90; angulo++){
    miServo.write(angulo);
    delay(15);
    }
    
  delay(3000);
  digitalWrite(verde, LOW);
  delay(3000);
  }
  else
  {
    Serial.println("Esperando usuario");
    delay(1000);
  }

}