Professional Documents
Culture Documents
Ver
Ver
h>
#include <LiquidCrystal_I2C.h>
#include <Servo.h>
void setup()
{
lcd.init();
lcd.backlight();
pinMode( 2 , INPUT );
pinMode( 3 , OUTPUT );
servos[6].attach(6);
pinMode(13,OUTPUT);
pinMode(12,OUTPUT);
void loop()
{
if (u_distancia(3,2) <= 15) {
servos[6].write(180);
digitalWrite(13,HIGH);
digitalWrite(12,LOW);
delay(1000);
}else {
servos[6].write(90);
digitalWrite(13,LOW);
digitalWrite(12,HIGH);
delay(1000);
}
lcd.setCursor(3, 0);
lcd.print("INSTITUTO");
lcd.setCursor(8, 1);
lcd.print("MICHEL");
delay(1000);
//sensor de ultrasonido
long u_tiempo(int trigger_pin, int echo_pin)
{
digitalWrite(trigger_pin, LOW);
delayMicroseconds(2);
digitalWrite(trigger_pin, HIGH);
delayMicroseconds(10);
digitalWrite(trigger_pin, LOW);
long microseconds = pulseIn(echo_pin ,HIGH);
return microseconds;
}
long u_distancia(int trigger_pin, int echo_pin)
{
long microseconds = u_tiempo(trigger_pin, echo_pin);
long u_distancia;
u_distancia = microseconds/29/2;
if (u_distancia == 0){
u_distancia = 999;
}
return u_distancia;
}