#define ECHO_PIN 15
#define TRIG_PIN 4

float jarak=0;
float kedalaman=0;


void bacaJarak()
{
  //Generate ultrasonic signal
  digitalWrite(TRIG_PIN, LOW);
  delayMicroseconds(2);
  digitalWrite(TRIG_PIN, HIGH);
  delayMicroseconds(10);
  digitalWrite(TRIG_PIN, LOW);

    //Read ultrasonic signal
  int duration = pulseIn(ECHO_PIN, HIGH);
  float jarak = duration * 0.034 / 2;
  float level_air=400-duration*0.034/2;
  //float kedalaman=jarak+level_air;
  Serial.print("Jarak: ");
  Serial.print(jarak);
  Serial.println(" CM");
  Serial.print("Level Air:");
  Serial.println(level_air);

}


void setup()
{

  Serial.begin(9600);
 // blynk
  pinMode(TRIG_PIN, OUTPUT);
  pinMode(ECHO_PIN, INPUT);

}

void loop()
{
 
  bacaJarak();
  /*kedalaman=400-jarak;
  Serial.print("Kedalaman: ");
  Serial.print(kedalaman);
  Serial.println(" CM");*/


  if( jarak > 100 && jarak < 150)
  {
    Serial.println("Kuning (Waspada)");
    //digitalWrite(Led_K, HIGH);
  }
  else if (jarak > 0 && jarak < 100)
  {
    Serial.println("Merah (Bahaya)");
    //digitalWrite(Led_M, HIGH);
  }
  else 
  {
    Serial.println("Hijau (Normal)");
    //digitalWrite(Led_H, HIGH);
  }
 delay(1000);
}