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

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

int x=A0, y=A1;
int nilaiX, nilaiY;
int pb1 = 2;
int pb2 = 4;
int statPb1;
int statPb2;

void setup() {
  lcd.begin();
  lcd.init;
  lcd.print("ROBONINO");
  delay(2000);
  lcd.clear;

  servo1.attach(11);
  servo2.attach(10);
  servo3.attach(9);
  pinMode(x, INPUT);
  pinMode(y, INPUT);
  pinMode(pb1, INPUT);
  pinMode(pb2, INPUT);
  Serial.begin(9600);
}

void loop() {
  nilaiX = map(analogRead(x), 0, 1023, 0, 180);
  nilaiY = map(analogRead(y), 0, 1023, 0, 180);

  servo1.write(nilaiX);
  servo2.write(nilaiY);

  statPb1 = digitalRead(pb1);
  statPb2 = digitalRead(pb2);

  if(statPb1 == HIGH){
    servo3.write(360);
  }else{
    servo3.write(0);
  }

  
  Serial.print(statPb1);
}