You are on page 1of 2

#include <SoftwareSerial.

h>
#include <Servo.h>//LIBRERIA PARA EL SERVO
#include <Wire.h> //LIBRERIA PAR EL LCD
#include <LiquidCrystal_I2C.h>//LIBRERIA PARA EL LCD I2C CON SOLO 4 PINES
LiquidCrystal_I2C lcd(0x27,16,2);//LCD TIPO LIQUIDCRISTAL_I2C (,TAMANIO)

int trigPin1=2;
int echoPin1=3;

int trigPin2=4;
int echoPin2=5;
Servo servo;

#define SIM800_PULSADOR 9
int contador = 0;
SoftwareSerial MOD_SIM800L(7, 8);

void setup() {
pinMode(trigPin1, OUTPUT);
pinMode(echoPin1, INPUT);
pinMode(trigPin2, OUTPUT);
pinMode(echoPin2, INPUT);
servo.attach(12);

// Inicializar el LCD
lcd.init();
//Encender la luz de fondo.
lcd.backlight();
// Escribimos el Mensaje en el LCD.

Serial.begin(115200);
while(!Serial);
//Veloci de trabajo entre el Arduino Uno y el Modulo SIM800L
MOD_SIM800L.begin(115200);
delay(1000);
pinMode (SIM800_PULSADOR, INPUT);
}

void loop() {
long duration1, d1;
digitalWrite(trigPin1, LOW); // Added this line
delayMicroseconds(2); // Added this line
digitalWrite(trigPin1, HIGH);
delayMicroseconds(10); // Added this line
digitalWrite(trigPin1, LOW);
duration1 = pulseIn(echoPin1, HIGH);
d1 = (duration1/2) / 29.1;//d = t/59;
delay(200);
long duration2, d2;
digitalWrite(trigPin2, LOW);
delayMicroseconds(2);
digitalWrite(trigPin2, HIGH);
delayMicroseconds(10);
digitalWrite(trigPin2, LOW);
duration2 = pulseIn(echoPin2, HIGH);
d2= (duration2/2) / 29.1;

delay(200);
if(d2>10){
if(d1>50){
servo.write(180);
}else{
servo.write(80);
}
}else{
lcd.print("Esta lleno!, por");
lcd.print("favor vac�alo!");

}
delay(200);
lcd.clear();
}

You might also like