#include <Servo.h>
#include <LiquidCrystal_I2C.h>
Servo servo13;
int trigger = 2;
int echo = 3;
LiquidCrystal_I2C lcd(0x27,16,2);
void setup() {
Serial.begin(9600);
pinMode(trigger, OUTPUT);
pinMode(echo, INPUT);
digitalWrite(trigger, LOW);
servo13.attach(13);
servo13.write(180);
lcd.init();
lcd.backlight();
}
void loop() {
int dist = ultra();
if (dist<=200 && dist>=10)
{
Serial.print(dist);
Serial.println(" cm");
servo13.write(75);
//
lcd.clear();
lcd.setCursor(0,0);
lcd.print("La distancia es:");
lcd.setCursor(6,1);
lcd.print(dist);
lcd.print(" cm");
delay(1000);
}
else
{
Serial.println("Fuera de rango");
//
lcd.clear();
lcd.setCursor(0,0);
lcd.print("Fuera de Rango");
servo13.write(0);
delay(1000);
}
}
int ultra()
{
digitalWrite(trigger, HIGH);
delayMicroseconds(10);
digitalWrite(trigger, LOW);
float t = pulseIn(echo, HIGH);
float d = t/59;
return d;
}