#include <ESP32Servo.h>

Servo servoX;
Servo servoY;

const int joyX = A0;      // Joystick X-axis
const int joyY = A1;      // Joystick Y-axis
const int servoXPin = 6;  // Servo 1 (X-axis)
const int servoYPin = 7;  // Servo 2 (Y-axis)

void setup() {
  Serial.begin(115200);
  servoX.setPeriodHertz(50);
  servoY.setPeriodHertz(50);
  servoX.attach(servoXPin, 500, 2400);
  servoY.attach(servoYPin, 500, 2400);
}

void loop() {
  int xVal = analogRead(joyX);
  int yVal = analogRead(joyY);

  int angleX = map(xVal, 0, 4095, 0, 180);
  int angleY = map(yVal, 0, 4095, 0, 180);

  servoX.write(angleX);
  servoY.write(angleY);

  Serial.print("X: ");
  Serial.print(xVal);
  Serial.print(" → ");
  Serial.print(angleX);
  Serial.print("°, Y: ");
  Serial.print(yVal);
  Serial.print(" → ");
  Serial.println(angleY);

  delay(15);
}