#include <ESP32Servo.h>
#include <LiquidCrystal_I2C.h>


const int servoPin = 13;
const int servoPin2 = 12;

Servo servo;
Servo servo2;
LiquidCrystal_I2C lcd(0x27, 16, 2);


void setup() {
  lcd.init();
  lcd.backlight();
  Serial.begin(115200);
  servo.attach(servoPin, 500, 2400);
  servo2.attach(servoPin2, 500,24000);
}

int pos = 0;

void loop() {
  const int x_val=analogRead(14);
  const int y_val=analogRead(27);
  delay(100);
  lcd.clear();
  lcd.setCursor(0,0);
  
  if(x_val<1000){
    lcd.print("Right");
    lcd.print("X: ");
    lcd.print(servo.read());
    pos=pos+5;
    servo.write(pos);
  }
  else if (x_val>3000){
    lcd.print("Left");
    lcd.print("X: ");
    lcd.print(servo.read());
    pos=pos-5;
    servo.write(pos);
  }
  else if (y_val<1000){
    lcd.print("Down");
    lcd.print("Y: ");
    lcd.print(servo2.read());
    pos=pos+5;
    servo2.write(pos);
  }
  else if(y_val>3000){
    lcd.print("Up");
    lcd.print("Y: ");
    lcd.print(servo2.read());
    pos=pos-5;
    servo2.write(pos);
  }
  else{
    lcd.print("Centre");
  }
}