You are on page 1of 2

#include <Wire.

h>
#include <LiquidCrystal_I2C.h>

#include <Servo.h>

Servo servos[13];LiquidCrystal_I2C lcd( 0x27, 16, 2);


//sensor de ultrasonido
long u_tiempo(int trigger_pin, int echo_pin);
long u_distancia(int trigger_pin, int echo_pin);

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

You might also like