#include <Servo.h>

#include <LiquidCrystal_I2C.h>

LiquidCrystal_I2C lcd(0x27, 16, 2);




Servo servo1;
Servo servo2;

int servo1pin = 3;

int servo2pin = 4;

int angulo1 = 0;

int angulo2 = 0;

int buttonPin1 = 6;

int buttonPin2 = 7;

int buttonPin3 = 8;

int buttonPin4 = 9;

int buttonState1 = 0;

int buttonState2 = 0;

int buttonState3 = 0;

int buttonState4 = 0;

void setup() {

  servo1.attach(servo1pin);

  servo2.attach(servo2pin);    

  pinMode(buttonPin1, INPUT);

  pinMode(buttonPin2, INPUT);

  pinMode(buttonPin3, INPUT);

  pinMode(buttonPin4, INPUT);

  servo1.write(angulo1);

  servo2.write(angulo2);

  lcd.init();
  lcd.begin(16,2);
  lcd.backlight();

  lcd.print("CAJA ELECTRONICA");
  delay (1000);
  lcd.clear();

}


void loop() {

  buttonState1 = digitalRead(buttonPin1);

  buttonState2 = digitalRead(buttonPin2);

  buttonState3 = digitalRead(buttonPin3);

  buttonState4 = digitalRead(buttonPin4);


  if (buttonState1 == HIGH)

  {
    lcd.clear();
    lcd.setCursor(0, 0);
    lcd.print ("BTN_ST_1");

    angulo1++;

    if (angulo1 >= 180)

    {

      angulo1 = 180;   

    }

  }



  if (buttonState2 == HIGH)

  {
    lcd.clear();
    lcd.setCursor(0, 0);
    lcd.print ("BTN_ST_2");
    angulo1--;

    if (angulo1 <= 0)

    {

      angulo1 = 0;

    }

  }

  if (buttonState3 == HIGH)

  {
    lcd.clear();
    lcd.setCursor(0, 0);
    lcd.print ("BTN_ST_3");

    angulo2++;

    if (angulo2 >= 180)

    {

      angulo2 = 180;   

    }

  }



  if (buttonState4 == HIGH)

  {
    lcd.clear();
    lcd.setCursor(0, 0);
    lcd.print ("BTN_ST_4");
    angulo2--;

    if (angulo2 <= 0)

    {

      angulo2 = 0;

    }

  }

  servo1.write(angulo1);

  servo2.write(angulo2);


  delay(1);
}