#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);
}