#include <WiFi.h>
#include <PubSubClient.h>
#include <ESP32Servo.h>
const char* ssid = "Wokwi-GUEST";
const char* password = "";
const char* mqttServer = "mqtt.eclipseprojects.io";
int mqttPort = 1883;
const char* current_topic = "LR8/Client1/servo1";
const char* targeted_topic = "LR8/Client2/pos2";
WiFiClient espClient;
PubSubClient client(espClient);
Servo servo;
const int servoPin = 18;
int angle = 0;
void callback(char* topic, byte* payload, unsigned int length) {
  String message;
  for (int i = 0; i < length; i++) {
    message += (char)payload[i]; }
  angle = message.toInt();
  Serial.print("Moving servo to angle: ");
  Serial.println(angle);
  servo.write(angle);
  client.publish(current_topic, String(angle).c_str());}
void setup() {
  Serial.begin(115200);
  servo.attach(servoPin, 500, 2400);
  WiFi.begin(ssid, password);
  while (WiFi.status() != WL_CONNECTED) {
    delay(500);
    Serial.print("."); }
  Serial.println("WiFi connected");
  client.setServer(mqttServer, mqttPort);
  client.setCallback(callback);
  while (!client.connected()) {
    Serial.println("Connecting to MQTT...");
    if (client.connect("ESP32Client")) {
      Serial.println("Connected to MQTT");} 
      else {
      Serial.print("Failed, rc=");
      Serial.print(client.state());
      delay(2000); }}
  client.subscribe(targeted_topic);}
void loop() {
  client.loop();}