#include <Wire.h>
#include <WiFi.h>
#include <PubSubClient.h>
#include <DHTesp.h>

const int DHT_PIN = 15;
DHTesp dht;
const char* ssid = "Wokwi-GUEST"; // SSID da rede Wi-Fi
const char* password = ""; // Senha da rede Wi-Fi
const char* mqtt_server = "test.mosquitto.org"; // URL do servidor Mosquitto

WiFiClient espClient;
PubSubClient client(espClient);
unsigned long lastMsg = 0;
float temp = 0;
float hum = 0;

// Endereco I2C do sensor MPU-6050
const int MPU = 0x68;

// Variaveis para armazenar valores do sensor MPU-6050
float AccX, AccY, AccZ, TempMPU, GyrX, GyrY, GyrZ;

// Função para configurar a conexão Wi-Fi
void setup_wifi() {
delay(10);
Serial.println();
Serial.print("Conectando a ");
Serial.println(ssid);

WiFi.mode(WIFI_STA);
WiFi.begin(ssid, password);

while (WiFi.status() != WL_CONNECTED) {
delay(500);
Serial.print(".");
}

randomSeed(micros());

Serial.println("");
Serial.println("Wi-Fi conectado");
Serial.println("Endereço IP: ");
Serial.println(WiFi.localIP());
}

// Função de retorno de chamada para mensagens MQTT recebidas
void callback(char* topic, byte* payload, unsigned int length) {
Serial.print("Mensagem recebida [");
Serial.print(topic);
Serial.print("] ");
for (int i = 0; i < length; i++) {
Serial.print((char)payload[i]);
}
}

// Função para reconectar ao servidor MQTT
void reconnect() {
while (!client.connected()) {
Serial.print("Tentando conexão MQTT...");
String clientId = "ESP32Client-";
clientId += String(random(0xffff), HEX);
if (client.connect(clientId.c_str())) {
Serial.println("Conectado");
client.publish("/ThinkIOT/Publish", "Bem-vindo");
client.subscribe("/ThinkIOT/Subscribe");
} else {
Serial.print("falha, rc=");
Serial.print(client.state());
Serial.println(" tentando novamente em 5 segundos");
delay(5000);
}
}
}

void setup() {
pinMode(2, OUTPUT);
Serial.begin(115200);
setup_wifi();
client.setServer(mqtt_server, 1883);
client.setCallback(callback);
dht.setup(DHT_PIN, DHTesp::DHT22);

// Inicializa o MPU-6050
Wire.begin();
Wire.beginTransmission(MPU);
Wire.write(0x6B);
Wire.write(0);
Wire.endTransmission(true);

// Configura Giroscópio para fundo de escala desejado
Wire.beginTransmission(MPU);
Wire.write(0x1B);
Wire.write(0b00011000); // Trocar esse comando para fundo de escala desejado conforme acima
Wire.endTransmission();

// Configura Acelerometro para fundo de escala desejado
Wire.beginTransmission(MPU);
Wire.write(0x1C);
Wire.write(0b00011000); // Trocar esse comando para fundo de escala desejado conforme acima
Wire.endTransmission();
}

void loop() {
// Comandos para iniciar transmissão de dados do MPU-6050
Wire.beginTransmission(MPU);
Wire.write(0x3B);
Wire.endTransmission(false);
Wire.requestFrom(MPU, 14, true); // Solicita os dados ao sensor

// Armazena o valor dos sensores nas variaveis correspondentes do MPU-6050
AccX = Wire.read() << 8 | Wire.read();
AccY = Wire.read() << 8 | Wire.read();
AccZ = Wire.read() << 8 | Wire.read();
TempMPU = Wire.read() << 8 | Wire.read();
GyrX = Wire.read() << 8 | Wire.read();
GyrY = Wire.read() << 8 | Wire.read();
GyrZ = Wire.read() << 8 | Wire.read();

// Imprime na Serial os valores obtidos do MPU-6050
Serial.print("MPU6050: ");
Serial.print("AccX=");
Serial.print(AccX / 2048.0);
Serial.print(" AccY=");
Serial.print(AccY / 2048.0);
Serial.print(" AccZ=");
Serial.print(AccZ / 2048.0);
Serial.print(" Temp=");
Serial.print(TempMPU / 340.0 + 36.53); // Converte para temperatura em graus Celsius
Serial.print(" GyrX=");
Serial.print(GyrX / 16.4);
Serial.print(" GyrY=");
Serial.print(GyrY / 16.4);
Serial.print(" GyrZ=");
Serial.println(GyrZ / 16.4);

// Leitura de dados do DHT22
TempAndHumidity data = dht.getTempAndHumidity();
temp = data.temperature;
hum = data.humidity;

// Publica dados no MQTT
if (!client.connected()) {
reconnect();
}
client.loop();

unsigned long now = millis();
if (now - lastMsg > 1500) { // Publica dados a cada 2 segundos
lastMsg = now;

String tempStr = String(temp, 2);
client.publish("/Encostas/temp", tempStr.c_str());

String humStr = String(hum, 1);
client.publish("/Encostas/hum", humStr.c_str());

client.publish("/Encostas/accX", String(AccX / 2048.0).c_str());
client.publish("/Encostas/accY", String(AccY / 2048.0).c_str());
client.publish("/Encostas/accZ", String(AccZ / 2048.0).c_str());
client.publish("/Encostas/tempMPU", String(TempMPU / 340.0 + 36.53).c_str());
client.publish("/Encostas/gyrX", String(GyrX / 16.4).c_str());
client.publish("/Encostas/gyrY", String(GyrY / 16.4).c_str());
client.publish("/Encostas/gyrZ", String(GyrZ / 16.4).c_str());


Serial.print("DHT22: ");
Serial.print("Temperatura=");
Serial.print(temp);
Serial.print(" Umidade=");
Serial.println(hum);
}

// Atraso de 100ms
delay(2500);
}