#include <LiquidCrystal_I2C.h>
LiquidCrystal_I2C lcd(0x27, 20, 4);

#define gocX A0
#define gocY A1
#define NutluuA 13 
#define NutluuB 12
#define Nutdichuyen 7
#include <Servo.h>
Servo myservo[4]; //Khai báo mãng servo
int ServoPin[]={6,9,10,11}; //Khai báo các chân servo
int IdxServo=0; //con servo đc được chọn vd=0 tức con có chân tại ServoPin[0] tức 3 đc được chọn
int Goc[]={0,0,0,0}; //Khai báo góc của các servo

void setup() {
  lcd.init();
  lcd.backlight();
  lcd.setCursor(0,0);
  pinMode(gocX, INPUT);
  pinMode(gocY, INPUT);
  pinMode(NutluuA, INPUT_PULLUP);
  pinMode(NutluuB, INPUT_PULLUP);
  pinMode(Nutdichuyen, INPUT_PULLUP);
//cau b
  for(int i=0;i<4;i++){
    myservo[i].attach(ServoPin[i]);
    myservo[i].write(Goc[i]);
  }
}
void loop() {
//cau c
  int X = analogRead(gocX);
  int Y = analogRead(gocY);
  Serial.print(X);
  Serial.print(Y);

  lcd.setCursor(0,0);
  lcd.print("X: ");
  lcd.print(X);
  lcd.print("        ");
  lcd.print("Y: ");
  lcd.print(Y);
}