#include <WiFi.h>
#include <PubSubClient.h>
#include <ESP32Servo.h>
Servo sm;

const char* ssid = "Wokwi-GUEST";
const char* password = "";

const char* mqtt_server = "test.mosquitto.org";

WiFiClient ClienteWokwi;
PubSubClient client(ClienteWokwi);

#define pin_sm 25

void setup() {
  Serial.begin(115200);

  sm.attach(pin_sm);
  sm.write(100);

  conectWiFi();

  client.setServer(mqtt_server, 1883);
  client.setCallback(recebe_dados);
}

void loop() {
  if (!client.connected()) {
    reconnect();
  }
  client.loop();
}

void reconnect() {
  while (!client.connected()) {
    Serial.print("Estabelecendo conexao MQTT...");
    if (client.connect("ClienteWokwi")) {
      Serial.println("Conectado");
      client.subscribe("servoctrl");
    } else {
      Serial.print("failed, rc=");
      Serial.print(client.state());
      Serial.println(" tentando novamente em 5 segundos");
      // Aguardando 5 segundos
      delay(5000);
    }
  }
}

void recebe_dados(char* topico, byte* payload, uint8_t length)
{
  String msg;
  for(int i=0;i<length;i++){
    char c=(char)payload[i];
    msg+=c;
  }
  Serial.print(topico);
  Serial.print("=");
  Serial.println(msg);
  int ang=msg.toInt();
  sm.write(ang);
}

void conectWiFi(){
  Serial.print("Conectando... ");
  Serial.print(ssid);
  WiFi.mode(WIFI_STA);
  WiFi.begin(ssid, password,6);
  while (WiFi.status() != WL_CONNECTED) {
    delay(500);
    Serial.print(".");
  }
  Serial.println("WiFi connectado!");
  Serial.println("Endereco IP: ");
  Serial.println(WiFi.localIP());
}