#include <PubSubClient.h>
#include <WiFi.h>
#define TOPIC_SERVO    "topic7_potentiometer"
#define PUBLISH_DELAY 1800  
#define ID_MQTT "servo_chaling" 
const char *SSID = "Wokwi-GUEST"; 
const char *PASSWORD = "";       
const char *BROKER_MQTT = "broker.hivemq.com";
int BROKER_PORT = 1883; 
WiFiClient espClient;         
PubSubClient MQTT(espClient); 
void initWiFi(void);
void initMQTT(void);
void callbackMQTT(char *topic, byte *payload, unsigned int length);
void reconnectMQTT(void);
void reconnectWiFi(void);
void checkWiFIAndMQTT(void);
const int servoPin = 16; 
const int PWMFreq = 50;
const int PWMChannel = 0;
const int PWMResolution = 12;
void initWiFi(void)
{
  delay(10);
  Serial.println("------Conexao WI-FI------");
  Serial.print("Conectando-se na rede: ");
  Serial.println(SSID);
  Serial.println("Aguarde");
  reconnectWiFi();
}
void initMQTT(void)
{
  MQTT.setServer(BROKER_MQTT, BROKER_PORT); // Informa qual broker e porta deve ser conectado
  MQTT.setCallback(callbackMQTT);           // Atribui função de callback (função chamada quando qualquer informação de um dos tópicos subescritos chega)
}
void callbackMQTT(char *topic, byte *payload, unsigned int length)
{
  String msg;
  for (int i = 0; i < length; i++) {
    char c = (char)payload[i];
    msg += c;
  }
  Serial.printf("Chegou a seguinte string via MQTT: %s do topico: %s\n", msg, topic);
  ledcWrite(PWMChannel, deg2sinal(msg.toInt()));
}
void reconnectMQTT(void)
{
  while (!MQTT.connected()) {
    Serial.print("* Tentando se conectar ao Broker MQTT: ");
    Serial.println(BROKER_MQTT);
    if (MQTT.connect(ID_MQTT)) {
      Serial.println("Conectado com sucesso ao broker MQTT!");
      MQTT.subscribe(TOPIC_SERVO);
    } else {
      Serial.println("Falha ao reconectar no broker.");
      Serial.println("Nova tentativa de conexao em 2 segundos.");
      delay(2000);
    }
  }
}
void checkWiFIAndMQTT(void)
{
  if (!MQTT.connected())
    reconnectMQTT(); 
  reconnectWiFi(); 
}
void reconnectWiFi(void)
{
  if (WiFi.status() == WL_CONNECTED)
    return;
  WiFi.begin(SSID, PASSWORD); 
  while (WiFi.status() != WL_CONNECTED) {
    delay(100);
    Serial.print(".");
  }
  Serial.println();
  Serial.print("Conectado com sucesso na rede ");
  Serial.print(SSID);
  Serial.println("IP obtido: ");
  Serial.println(WiFi.localIP());
}
void setup()
{
  Serial.begin(115200);
  ledcSetup(PWMChannel, PWMFreq, PWMResolution);
  ledcAttachPin(servoPin, PWMChannel);
  ledcWrite(PWMChannel, deg2sinal(0));
  initWiFi();
  initMQTT();
}
void loop()
{
  checkWiFIAndMQTT();
  MQTT.loop();
  delay(PUBLISH_DELAY);
}
int deg2sinal(int deg) {
  return map(deg, 0, 180, 113, 491);
}