#include <ESP32Servo.h>
#include <Arduino.h>
const int servoAPin=2;//伺服馬達
const int servoBPin=4;
const int x = 12;
const int y = 13;//搖桿
const int key = 14;
Servo servoA,servoB;

void setup() {
  servoA.attach(servoAPin,500,2400);
  servoB.attach(servoBPin,500,2400);
  Serial.begin(115200);
  pinMode(key,INPUT);
}
void loop() {
  int x_value = analogRead(x);
  int y_value = analogRead(y);
  int key_value = digitalRead(key);
  Serial.print("X:");
  Serial.print(x_value);
  Serial.print(" Y:");
  Serial.print(y_value);
  Serial.print(" Z:");
  Serial.println(key_value);
  if(x_value==4095||y_value==4095){
    servoA.write(180);
    servoB.write(180);
  }
  else{
    servoA.write(0);
    servoB.write(0);
  }
  delay(10);
}