#include <Servo.h>
Servo servo;
int trigPin=7;
int echoPin=6;
void setup(){
servo.attach(9);
pinMode(trigPin,OUTPUT);
pinMode(echoPin,INPUT);
Serial.begin(9600);
servo.write(0);
}
void loop(){
long duracion,distancia;
digitalWrite(trigPin,LOW);
delayMicroseconds(2);
digitalWrite(trigPin,HIGH);
delayMicroseconds(10);
digitalWrite(trigPin,LOW);
duracion=pulseIn(echoPin,HIGH) ;
distancia=duracion*0.034/2;
Serial.print(distancia);
Serial.println("cm");
delay(500);
if(distancia<20){
servo.write(90);
delay(4000);
servo.write(0);
}
}
No hay comentarios:
Publicar un comentario