viernes, 17 de abril de 2015

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

En esta entrada vamos a realizar una simulación de dos puertas de paso con dos servos y un sensor de "presencia", en nuestro caso un ultrasonidos HC-SR4. Además, incluiremos un led que indica puertas abiertas.


Material 

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


Esquema

Programa

* Librería descargada de la siguiente página:
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);  
}    

Os animamos a subir vuestros vídeos del tutorial funcionando en nuestro Facebook
nombrándonos en Twitter.

P.