#include <WiFi.h>
#include "ThingsBoard.h"
#include "DHTesp.h"
#include <ESP32Servo.h>
#include <PubSubClient.h>

#define CURRENT_FIRMWARE_TITLE "TEST"
#define CURRENT_FIRMWARE_VERSION "1.0.0"

#define SSID "Wokwi-GUEST"
#define PASS ""

#define TOKEN "EMHJUnaStO6iFfNuSslv"
#define THINGSBOARD_SERVER "thingsboard.cloud"

#define SERIAL_DEBUG_BAUD 115200
const int DHT_PIN = 15;

#define ECHO_PIN 4
#define TRIG_PIN 2
#define pinBuzzer 5

int status = WL_IDLE_STATUS;

int ledPin = 12;                
int inputPin = 14;               
int pirState = LOW;             
int val = 0;                   

WiFiClient client;
ThingsBoard tb(client);
DHTesp dhtSensor;

Servo myservo;  
  

float readDistanceCM() {
  digitalWrite(TRIG_PIN, LOW);
  delayMicroseconds(2);
  digitalWrite(TRIG_PIN, HIGH);
  delayMicroseconds(10);
  digitalWrite(TRIG_PIN, LOW);
  int duration = pulseIn(ECHO_PIN, HIGH);
  return duration * 0.034 / 2;
}



void setup() {
  pinMode(TRIG_PIN, OUTPUT);
  pinMode(ECHO_PIN, INPUT);
  Serial.begin(115200);
  pinMode(pinBuzzer, OUTPUT);
  myservo.attach(13);  
  WiFi.disconnect();
  WiFi.begin("Wokwi-GUEST", "");
  while ((!(WiFi.status() == WL_CONNECTED))) {
    delay(300);
    Serial.print(".");
  }
    Serial.println("");
  Serial.println("WiFi connected");
  Serial.println("IP address: ");
  Serial.println(WiFi.localIP());
  Serial.begin(SERIAL_DEBUG_BAUD);
  WiFi.disconnect();
  dhtSensor.setup(DHT_PIN, DHTesp::DHT22);
  pinMode(ledPin, OUTPUT);     
  pinMode(inputPin, INPUT);
}

void loop() {
   if(WiFi.status() != WL_CONNECTED){
    reconnect();
  }

  if(!tb.connected()) {
      Serial.println("Connecting to: ");
      Serial.print(THINGSBOARD_SERVER);
      Serial.print(" with token ");
      Serial.println(TOKEN);
      if(!tb.connect(THINGSBOARD_SERVER, TOKEN)){
        Serial.println("Failed to connect");
        return;
      }
  }
  Serial.println("Sending data...");

  float distance = readDistanceCM();

  Serial.print("Measured distance: ");
  Serial.println(distance);
  tb.sendTelemetryFloat("Jarak", distance);
  if(distance <= 200){    
    myservo.write(90);
       tb.sendTelemetryString("Servo", "Terbuka");
        delay(15);
   tone(pinBuzzer, 1000);
    delay(200);     
    tone(pinBuzzer, 500);
    delay(200);
   tb.sendTelemetryString("Buzzer", "Berbunyi");
    }
  else{
    myservo.write(0);
    noTone(pinBuzzer);
    tb.sendTelemetryString("Servo", "Tertutup"); 
    tb.sendTelemetryString("Buzzer", "Senyap");
  } 
                       
  TempAndHumidity  data = dhtSensor.getTempAndHumidity();
  tb.sendTelemetryInt("Temperatur", data.temperature);
  tb.sendTelemetryFloat("Kelembaban", data.humidity);

  Serial.println("Temp: " + String(data.temperature, 2) + "°C");
  Serial.println("Humidity: " + String(data.humidity, 1) + "%");
  Serial.println("---");
  
val = digitalRead(inputPin);  
  if (val == HIGH) {            // check if the input is HIGH
    digitalWrite(12, HIGH);  // turn LED ON
    if (pirState == LOW) {
      // we have just turned on
      Serial.println("Motion detected!");
      // We only want to print on the output change, not state
      pirState = HIGH;
    }
  } else {
    digitalWrite(ledPin, LOW); // turn LED OFF
    if (pirState == HIGH) {
      // we have just turned of
      Serial.println("Motion ended!");
      // We only want to print on the output change, not state
      pirState = LOW;
    }
  }
 tb.loop();
  }