Tutorial Arduino: Simulación puertas de paso con 2 servos y ultrasonidos 3/5 (2)

En este tutorial vamos a pasar a la acción aprendiendo a realizar una simulación puertas de paso con 2 servos y ultrasonidos. Simulando dos puertas de paso con dos servos y un sensor de “presencia”, en nuestro caso un ultrasonidos HC-SR4. Además, añadiremos un led que indica puertas abiertas.

Material que necesitaremos

  • Arduino UNO
  • resistencia de 220 ohmnios
  • un sensor ultrasonidos HC-SR4
  • dos servos
  • protoboard
  • cableado

 

proyecto+2servosconultrasonidos bb - Tutorial Arduino: Simulación puertas de paso con 2 servos y ultrasonidos

Programa

* Librería descargada de la siguiente web:
Ultrasonic.h
#include <Servo.h>

// Ultrasonic - Library for HR-SC04 Ultrasonic Ranging Module.
// Rev.4 (06/2012)
// J.Rodrigo ( www.jra.so )
// more info at www.ardublog.com
#include <Ultrasonic.h>
Ultrasonic ultrasonic(3,4); // (Trig PIN,Echo PIN)
Servo miniservo1; /*declaro servo1*/
Servo miniservo2; /*declaro servo2*/
int led=7;
int distancia; 

void setup(){
  miniservo1.attach(10); /*usar pin 10 para el servo1*/
  miniservo2.attach(11); /*usar pin 11 para el servo2*/
  // coloca el servo en su posición central  
    miniservo1.write(90);
    miniservo2.write(90);
    pinMode(led, OUTPUT);// determinamos que nuestra variable led será de salida
}

void loop(){  
  
    distancia = ultrasonic.Ranging(CM); //Lectura sensor de ultrasonidos
     
    if(distancia <= 20){  //si la distancia es menor de 20...
  
        //movemos el servo en una dirección  
        miniservo1.write(180);
        miniservo2.write(0); 
        digitalWrite(led, HIGH);   // enciende el LED (HIGH)
        delay(500);   
    }else{  //si no hay nada, siguen en la posición inicial
    miniservo1.write(90);
    miniservo2.write(90);
    digitalWrite(led, LOW);   // apagamos el LED (LOW)
    }  
  
    delay(500);  
}    

Califique esto

También te puede interesar

Ayúdanos a crecer!!Comparte con tus amigos¡¡