#include <Wire.h>
#include <LiquidCrystal_I2C.h>
#include <Servo.h>

LiquidCrystal_I2C lcd(0x27, 16, 2);

Servo myServo1;
Servo myServo2;
Servo myServo3;
Servo myServo4;

int Pulsador1 = 5;
int Pulsador2 = 4;
int Pulsador3 = 3;
int Pulsador4 = 2;

void setup() {
  // put your setup code here, to run once:

  lcd.init();
  lcd.backlight();
    
  myServo1.attach(11);
  myServo2.attach(10);
  myServo3.attach(9);
  myServo4.attach(6);

  pinMode(Pulsador1, INPUT);
  pinMode(Pulsador2, INPUT);
  pinMode(Pulsador3, INPUT);
  pinMode(Pulsador4, INPUT);

  myServo1.write(0);
  myServo2.write(0);
  myServo3.write(0);
  myServo4.write(0);
}

void loop() {
  // put your main code here, to run repeatedly:
  int Valor_P1 = digitalRead(Pulsador1);
  int Valor_P2 = digitalRead(Pulsador2);
  int Valor_P3 = digitalRead(Pulsador3);
  int Valor_P4 = digitalRead(Pulsador4);

  if (Valor_P1 == LOW){
   
      myServo1.write(180);
      delay(1000);
      myServo1.write(0);
      lcd.setCursor(0,0);
      lcd.print("Motor 1");
      lcd.setCursor(0,1);
      lcd.print("Saludo");
      delay(3000);
      lcd.clear();
    
  }if (Valor_P2 == LOW){
    
      myServo2.write(180);
      delay(1000);
      myServo2.write(0);
      lcd.setCursor(0,0);
      lcd.print("Motor 2");
      lcd.setCursor(0,1);
      lcd.print("Mover Sombrero");
      delay(3000);
      lcd.clear();
    
  }if (Valor_P3 == LOW){
    
      myServo3.write(180);
      delay(1000);
      myServo3.write(0);
      lcd.setCursor(0,0);
      lcd.print("Motor 3");
      lcd.setCursor(0,1);
      lcd.print("Recoleccion");
      delay(3000);
      lcd.clear();
    
  }if (Valor_P4 == LOW){
    
      myServo4.write(180);
      delay(1000);
      myServo4.write(0);
      lcd.setCursor(0,0);
      lcd.print("Motor 4");
      lcd.setCursor(0,1);
      lcd.print("Baile");
      delay(3000);
      lcd.clear();
    
}
}