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