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

LiquidCrystal_I2C pantalla_verde(0x27,16,2);
Servo servo1;
Servo servo2;

void inicializacion_LCD(void){
  pantalla_verde.init();
  pantalla_verde.backlight();
  pantalla_verde.clear();
  pantalla_verde.setCursor(0,0);
  pantalla_verde.print(" Sem.5 SEMB UNI");
  pantalla_verde.setCursor(0,1);
  pantalla_verde.print(" Servomecanismos");
  delay(3000);
  pantalla_verde.clear();
  servo1.attach(6);
  servo2.attach(5);
}

void setup() {
  // put your setup code here, to run once:
  inicializacion_LCD();
  pinMode(2, INPUT_PULLUP);
}

void loop() {
  // put your main code here, to run repeatedly:
  unsigned int pot_1=0, pot_2=0;
  
  pot_1 = analogRead(0);
  pantalla_verde.print("Pot_1: ");
  pantalla_verde.print(map(pot_1,0,1023,0,180));
  pantalla_verde.write(0xDF);
  pantalla_verde.print("  ");
  servo1.write(map(pot_1,0,1023,0,180));

  pot_2 = analogRead(1);
  if(digitalRead(2) == 1){
    pantalla_verde.setCursor(0,0);
    pantalla_verde.setCursor(0,1);
    pantalla_verde.print("Pot_2: ");
    pantalla_verde.print(map(pot_2,0,1023,0,180));
    pantalla_verde.write(0xDF);
    pantalla_verde.print("  ");
    servo2.write(map(pot_2,0,1023,0,180));
  }
  else{
    pantalla_verde.setCursor(0,0);
    pantalla_verde.setCursor(0,1);
    pantalla_verde.print("Pot_2: ");
    pantalla_verde.print(map(pot_2,0,1023,180,0));
    pantalla_verde.write(0xDF);
    pantalla_verde.print("  ");
    servo2.write(map(pot_2,0,1023,180,0));

  }
}