#include <Servo.h>
Servo puerta;
int trig = 14;
int echo = 15;
long distancia = 0;
long duracion = 0;
int led1=2;
int led2=3;
void setup() {
pinMode(trig,OUTPUT);
pinMode(echo,INPUT);
pinMode(led1, OUTPUT);
pinMode(led2, OUTPUT);
Serial.begin(9600);
puerta.attach(23); //para fisico se usa ... puerta.attach(23,650,2550);
puerta.write(90);// noventa grados
}
void loop() {
digitalWrite(trig,0);
delayMicroseconds(2);
digitalWrite(trig,1);
delayMicroseconds(10);
digitalWrite(trig,0);
duracion=pulseIn(echo,1); //83333
distancia=duracion/58;
if(distancia<15){
digitalWrite(led1,1);
digitalWrite(led2,0);
puerta.write(180);// cero grados
delay(2000);
}
else{
digitalWrite(led1,0);
digitalWrite(led2,1);
puerta.write(90);
}
Serial.println(distancia);
delay(400);
}