#include <esp_now.h>
#include <WiFi.h>
#include <ESP32Servo.h>
Servo servo;
int currentAngle = 0;

typedef struct {
  int angle;
} Message;
Message incomingData;

void onReceive(const esp_now_recv_info_t *info, const uint8_t *data, int len) {
  memcpy(&incomingData, data, sizeof(incomingData));
  Serial.print("Received angle: ");
  Serial.println(incomingData.angle);

  servo.write(incomingData.angle);
  currentAngle = incomingData.angle;
}

void setup() {
  Serial.begin(115200);
  servo.attach(5);  // D5 pin
  servo.write(0);

  WiFi.mode(WIFI_STA);

  if (esp_now_init() != ESP_OK) {
    Serial.println("ESP-NOW init failed");
    return;
  }

  esp_now_register_recv_cb(onReceive);

  Serial.println("S3 Receiver ready");
}

void loop() {}