#include <WiFi.h>
#include "ThingsBoard.h"
#include <Stepper.h>

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

#define WIFI_SSID  "Wokwi-GUEST"
#define WIFI_PASSWORD ""

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

#define SERIAL_DEBUG_BAUD 115200

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

#define trig_pin 14
#define echo_pin 27

const int stepsPerRevolution = 200;
Stepper myStepper(stepsPerRevolution, 2, 4, 5, 19);

int j = 0;
bool state;

void InitWiFi(){
  Serial.println("Connecting to AP ...");
  WiFi.begin (WIFI_SSID, WIFI_PASSWORD);
  while (WiFi.status() != WL_CONNECTED){
    delay(500);
    Serial.print(".");
  }
    Serial.println("Connected");
}

void reconnect() {
  status = WiFi.status();
  if (status != WL_CONNECTED){
WiFi.begin (WIFI_SSID, WIFI_PASSWORD);
  while (WiFi.status() != WL_CONNECTED){
    delay(500);
    Serial.print(".");
  }
    Serial.println("Connected");
  }
}

int ultrasonic(){
  digitalWrite(trig_pin, LOW);
  delayMicroseconds(2);
  digitalWrite(trig_pin, HIGH);
  delayMicroseconds(10);
  digitalWrite(trig_pin, LOW);
  delayMicroseconds(2);

  int jarak = ((pulseIn(echo_pin, HIGH)*0.0343)/2);
  int ketinggian = 60-jarak;
  if(ketinggian < 0){
    ketinggian = 0;
  }
  return ketinggian;
}

int soil_sensor(){
  int soil_moisture = analogRead(34);
  int kelembaban =  map(soil_moisture, 0, 4095, 0, 100);
  return kelembaban;
}
void setup()
{
  myStepper.setSpeed(60);
  pinMode(trig_pin, OUTPUT);
  pinMode(echo_pin, INPUT);
  Serial.begin(SERIAL_DEBUG_BAUD);
  Serial.println();
  InitWiFi();
}


void loop()
{
  delay(1000);

  if ((ultrasonic() > 10 && state == true) && soil_sensor() < 80){
    myStepper.step(j);
    j= j + 1000;
    if(j > 1000){
      state = false;
      j = 0;
    }
    Serial.println("Counter Clockwise");
  }
  if(ultrasonic()<= 10 && state == false  ){
    myStepper.step(-j);
    j = j + 1000;
    if(j > 1000){
      state = true;
      j = 0;
    }
    Serial.println("Clockwise");
  }

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

  if(!tb.connected()){
    Serial.print("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.. ");
  tb.sendTelemetryFloat("kelembaban", soil_sensor());
  tb.sendTelemetryFloat("ketinggian air", ultrasonic());
  Serial.print("Kelembaban Tanah : ");
  Serial.print(soil_sensor());
  Serial.println("%");
  Serial.print("Ketinggian Air : ");
  Serial.print(ultrasonic());
  Serial.println(" cm");
  tb.loop();
}