#include <WiFi.h>
#include <Wire.h>
#include <LiquidCrystal_I2C.h>
#include "PubSubClient.h" //библиотека для работы с mqtt

const char triggerPin = 2; // Создаем переменные которые потом будут пинами
const char echoPin = 4;    // Создаем переменные которые потом будут пинами



const char* serverAddress = "192.168.1.100"; // IP адрес вашего сервера
const int serverPort = 80; // Порт для HTTP запросов



const char* ssid = "Wokwi-GUEST"; 
const char* willMessage = "Connection lost";
const char* willTopic = "MyDistance/LastWill";
const char* password = "";
const char* mqttServer = "broker.emqx.io"; //Один из серверов мы берем/Брокер с которым будем общатся
//Брокер - мой сервер, координирует систему
int port = 1883;
//String stMac; //Mac адресс
//char mac[50];
char clientId[50];
String distance_msg;
String distance_str;
WiFiClient espClient; //Передаю по вай ваю переменную клиент/Инициализация вайфай клиента, (мы клиент к чему мы будем подключатся)
PubSubClient client(espClient); //Функция с mqtt она говорит о том что передается переменная объект клиент и свой клиент
LiquidCrystal_I2C lcd(0x27, 20, 4); // Инициализация экрана LCD 20x4 через I2C


void setup() {
  lcd.init(); // Инициализация экрана LCD
  lcd.backlight(); // Включение подсветки экрана LCD

  pinMode(triggerPin, OUTPUT); // Этот пин объявляем оутпутом
  pinMode(echoPin, INPUT); // Этот пин объявляем инпутом

 Serial.begin(115200); //Задает скорость передачу данных по последовательному интерфейсу
  randomSeed(analogRead(0)); //

  delay(10);
  Serial.println();
  Serial.print("Connecting to ");
  Serial.println(ssid);

  wifiConnect(); //вызиваем функцию

  Serial.println("");
  Serial.println("WiFi connected");
  Serial.println("IP address: ");
  Serial.println(WiFi.localIP());
 // Serial.println(WiFi.macAddress()); //WIFI.macAddress функция с библиотеки WIFI.H оно возвращает стриногое значение мак адресс к которому подключились
  //stMac = WiFi.macAddress(); //записываем СТМак макадресс
 // stMac.replace(":", "_"); //Мак адрес выглядит как 4 чилса пробел 4 числа
  //Serial.println(stMac); //виводим мак адресс
  
  client.setServer(mqttServer, port); //mqtt библиотеке есть функция Client. клиент точка сетсервер - мы устанавливаем сервер. Передаем параметри mqttserver и порт
  client.setCallback(callback); //Передает функцию callback/ я подписался на топик, с топика идет сообщение - callback
}
void wifiConnect() { //Создали функцию в которой есп конектится по вайфаю
  WiFi.mode(WIFI_STA); //Работа с вайфай платой есть два режима, Домашний вайфай роутер для локальная сеть СТА, точка доступа АП
  WiFi.begin(ssid, password); //Wifi.begin начинают конекшн
  while (WiFi.status() != WL_CONNECTED) { //если не конектед, задержда 500мСК выводим точку и если нет ретерна, оно повторяет действие 
    delay(500);
    Serial.print(".");
  }
}
void mqttReconnect() {
  while (!client.connected()) {
    Serial.print("Attempting MQTT connection...");
    long r = random(1000); //делается рандомный айди клиента
    sprintf(clientId, "clientId-%ld", r); //
       if (client.connect(clientId, NULL, NULL, willTopic, 0, false, willMessage)) { //Если клиент подключен к серверу, то оно вернет тру 
       // При присоединение на сервер я добавляю переменные willMessage willTopic и потом как прирвется соединение, то в вилтопик придет сообщение.
      Serial.print(clientId);
      Serial.println(" connected");
      client.subscribe("MyDistance"); //подписысаемся к топику МайДистанс
    } else {
      Serial.print("failed, rc=");
      Serial.print(client.state()); //Если нет, то пишем неправильный клиент выводим состояние клиента
      Serial.println(" try again in 5 seconds");
      delay(5000);
    }
  }
}
void callback(char* topic, byte* message, unsigned int length) { //Передаем топик, меседж и длину (Обратно возвращаем с топика)
  Serial.print("Message arrived on topic: ");
  Serial.print(topic); //топик это то на что мы подписываемся. Ему отправляем сообщение и получаем от него сообщение
  Serial.print(". Message: ");
  String stMessage;
  
  for (int i = 0; i < length; i++) { //Собираем сообщение, сообщение возвращается в состоянии масиве(чаровского), чтобы собрать нужно пройтись по всем элементам и записать
    Serial.print((char)message[i]);
    stMessage += (char)message[i]; //приравниваем его к переменной СТМессадж
  }
  Serial.println();
  if (String(topic) == "MyDistance") { 
  distance_msg = stMessage; 
  //lcd.print("Відстань: ");
  lcd.print(distance_msg);
  lcd.print(" sm");
  }
}
void loop() {
  float duration, distance;

  digitalWrite(triggerPin, LOW);
  delayMicroseconds(2);

  digitalWrite(triggerPin, HIGH);
  delayMicroseconds(10);

  digitalWrite(triggerPin, LOW);

  duration = pulseIn(echoPin, HIGH);
  distance = (duration / 2.0) / 29.1; // Расчет расстояния в сантиметрах

  Serial.print("Расстояние: ");
  Serial.print(distance);
  Serial.println(" см");

  lcd.setCursor(0, 0);

const char* topic = "MyDistance"; //присваеваем название топика
distance_str = distance; //присваеваем стринговое значение
client.publish(topic, distance_str.c_str()); //Функция передаем топик это топик в котором мы публикуем и второй параметр это параметр который публикуем
//.с_str превращает стринговкий объект в чаровский набор объектов
  delay(1000);

  if (!client.connected()) { //если клиент не конектек, запускаем реконект
    mqttReconnect();
  }
  client.loop(); //Чтобы все происходило в цикле
  delay(1000); // Задержка перед следующим измерением расстояния
}