#include "CTBot.h";
#include <WiFi.h>
#include <WiFiClient.h>
#include <ArduinoJson.h>
#include <BlynkSimpleEsp32.h>

#define Echo 15
#define Trig 2
#define Merah 14
#define Kuning 12
#define Hijau 13
#define buzzer 26

String token = "6615261736:AAEQGpcZkXV8Z_dJWmbRxb-cOwJaS4ZfIew";
const int bot_id = 6242476867;


char ssid[] = "Wokwi-GUEST";
char pass[] = "";



float jarak = 0;
int nada;

void ukur_jarak(){
  digitalWrite(Trig, LOW);
  delay(10);
  digitalWrite(Trig, HIGH);
  delay(10);
  digitalWrite(Trig, LOW);

  int duration = pulseIn(Echo, HIGH);
  jarak = duration * 0.034 / 2 + 1;

  Serial.print("Jarak: ");
  Serial.print(jarak);
  Serial.println(" cm");
}

void output_jarak(){
  if(jarak > 400) {
    Serial.println("Aman");
    digitalWrite(Hijau, HIGH);
  }
  else if(jarak > 200 && jarak < 400) {
    Serial.println("Hama Mendekat!");
    digitalWrite(Kuning, HIGH);
  }
  else if(jarak < 200) {
    Serial.println("Ada Hama");
    digitalWrite(Merah, HIGH);
  }
}




void setup() {
  Serial.begin(115200);
 
  pinMode(Trig, OUTPUT);
  pinMode(Echo, INPUT);
  pinMode(Merah, OUTPUT);
  pinMode(Hijau, OUTPUT);
  pinMode(buzzer, OUTPUT);



 
  
}

void loop() {
  digitalWrite(Merah, LOW);
  digitalWrite(Kuning, LOW);
  digitalWrite(Hijau, LOW);

  ukur_jarak();

  output_jarak();


  
  delay(1000);
}