#include "ThingsBoard.h"
#include "PubSubClient.h"
#include "ESP8266WiFi.h"
#include "ESP8266HTTPClient.h"

#define ECHO_PIN D7
#define TRIG_PIN D6

#define SSID "Wokwi-GUEST"
#define PASS "1234567890"
#define TOKEN "aImm9HxucglxqkhvTz5u"
#define THINGSBOARD_SERVER "thingsboard.cloud"

WiFiClient client;
ThingsBoard tb(client);
int status = WL_IDLE_STATUS;

void reconnect(){
  status = WiFi.status();
  if(status!=WL_CONNECTED){
    WiFi.begin(SSID, PASS);
    while(WiFi.status() != WL_CONNECTED) {
      delay(500);
      Serial.println(".");
    }
    Serial.println("Connected to AP");
  }
}

void setup() {
  Serial.begin(9600);
  pinMode(TRIG_PIN, OUTPUT);
  pinMode(ECHO_PIN, INPUT);
  WiFi.disconnect();
  WiFi.begin("IoT", "1234567890");
  while ((!(WiFi.status() == WL_CONNECTED))) {
    delay(300);
    Serial.print(".");
  }
  Serial.println("");
  Serial.println("WiFi connected");
  Serial.println("IP address: ");
  Serial.println(WiFi.localIP());
 }

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 loop() {
  float distance = readDistanceCM();

  Serial.print("Jarak: ");
  Serial.println(distance);
  tb.sendTelemetryFloat("Jarak", distance);
  delay(1000);
    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;
      }
  }
  {
  tb.loop();
  }  
}