Tutorial Arduino: Simulación puertas de paso con 2 servos y ultrasonidos

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

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);  
}