martes, 15 de marzo de 2022

#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