#include <Servo.h>      // Loading Servo Motor Header Files
#include <WiFi.h>
#include <PubSubClient.h>

#define echoPin 15
#define trigPin 2  
int servoPin = 21;     

// WiFi
const char *ssid = "Wokwi-GUEST"; // nama wifi
const char *password = "";  // password wifi

// MQTT Broker
const char *mqtt_broker = "tcp.ap.ngrok.io";
const char *topic = "pakan";
const char *mqtt_username = "";
const char *mqtt_password = "";
const int mqtt_port = 16520 ;

WiFiClient espClient;
PubSubClient client(espClient);

//Servo Servo1;

void setup() {
  Serial.begin (9600); 
  pinMode(trigPin, OUTPUT);
  pinMode(echoPin, INPUT); 
  //Servo1.attach(servoPin);   
  WiFi.begin(ssid, password);
  while (WiFi.status() != WL_CONNECTED) {
     delay(500);
     Serial.println("Connecting to WiFi..");
 }
 Serial.println("Connected to the WiFi network");
 // menghubungkan ke mqtt lokal yang di forward dengan ngrok
 client.setServer(mqtt_broker, mqtt_port);
//  client.setCallback(callback);
 while (!client.connected()) {
     String client_id = "esp32-client-";
     client_id += String(WiFi.macAddress());
     Serial.printf("The client %s connects to the public mqtt broker\n", client_id.c_str());
     if (client.connect(client_id.c_str(), mqtt_username, mqtt_password)) {
         Serial.println("Public mqtt broker connected");
     } else {
         Serial.print("failed with state ");
         Serial.print(client.state());
         delay(2000);
     }
}
}

void loop() {
  client.loop();
  long waktu, jarak;
  digitalWrite(trigPin, LOW); 
  delayMicroseconds(2); 
  digitalWrite(trigPin, HIGH);
  delayMicroseconds(10);
  digitalWrite(trigPin, LOW);
  waktu = pulseIn(echoPin, HIGH);
  jarak = (waktu/2) / 29.1;

  if (jarak <= 200 || jarak <= 1){
    Serial.println("Pakan masih tersedia");
    //Servo1.write(0);
    client.publish(topic, "PAKAN TERSEDIA");
  }
  else {
    Serial.println("Isi ulang pakan");
    //Servo1.write(180);
    client.publish(topic, "PAKAN HABIS, SEGERA ISI ULANG!");
    delay(1000);
  }
  delay(1000);
}