#include <Servo.h>
#define trigPin 12
#define echoPin 8
Servo motorFJ;
void setup()
{
Serial.begin (9600);
pinMode(trigPin, OUTPUT);
pinMode(echoPin, INPUT);
motorFJ.attach(3);
}
void loop()
{
long duracion, distancia ;
digitalWrite(trigPin, LOW);
delayMicroseconds(2);
digitalWrite(trigPin, HIGH);
delayMicroseconds(10);
digitalWrite(trigPin, LOW);
duracion = pulseIn(echoPin, HIGH) ;
distancia = duracion / 2 / 29.1 ;
Serial.println(String(distancia) + " cm.") ;
int Limite = 20 ; // Medida en vacío del sensor
delay(2000);
if (distancia>10){
motorFJ.write(0);
}
if(distancia<10){
motorFJ.write(90);
}
}
No hay comentarios:
Publicar un comentario