#include <LiquidCrystal_I2C.h>
LiquidCrystal_I2C lcd(0x27,16,2);

#include <Servo.h>
Servo myservo[5];
int servopin[]={11,10,9,6};
int idservo=0;
int goc[]={0,0,0,0};

#define button 7
#define joy 4
#define led 2
#define trucX A1
#define trucY A0





void setup() {
  
  lcd.init();
  lcd.backlight();

  pinMode(trucX, INPUT);
  pinMode(trucY, INPUT);
  pinMode(button, INPUT_PULLUP);
  pinMode(joy, INPUT_PULLUP);

  for(int i=0; i<4; i++){
    myservo[i].attach(servopin[i]);
    myservo[i].write(goc[i]);
  }
}

void loop() {
  // put your main code here, to run repeatedly:



int X= analogRead(trucX);
int Y= analogRead(trucY);


if(X==1023){
  goc[idservo]+=1;

}else if (X==0){
  goc[idservo]-=1;

}

if(Y==1023){
  goc[idservo]+=20;
}else if(Y==0){
  goc[idservo]-=20;
}

if (goc[idservo]>180){
  goc[idservo]=180;
  }else if(goc[idservo]<0){

    goc[idservo]=0;
}

myservo[0].write(goc[idservo]);
myservo[1].write(goc[idservo]);
myservo[2].write(goc[idservo]);
myservo[3].write(goc[idservo]);

}