// ---------------------------------------------------------------------------
// Tutorial By IOT Fajar
// ---------------------------------------------------------------------------
#include <Servo.h>
#include <NewPing.h>

#define TRIGGER_PIN  A0  // Hubungkan Pin TRIG Sensor Ultrasonic pada Pin A0 Arduino
#define ECHO_PIN     A1  // Hubungkan Pin TRIG Sensor Ultrasonic pada Pin A1 Arduino
#define MAX_DISTANCE 200 // Setting jarak maksimum yang kita inginkan, biasanya maksimal sensor HC-SR04 adalah 5 Meter

NewPing sonar(TRIGGER_PIN, ECHO_PIN, MAX_DISTANCE);
Servo myservo;

int pos = 0;    // variable to store the servo position


void setup() {
  Serial.begin(9600); 
  pinMode(LED_BUILTIN, OUTPUT);

      }

      void lampu(){
          digitalWrite(LED_BUILTIN, HIGH);
          }
      void lampuMti(){
          digitalWrite(LED_BUILTIN, LOW);
      }

          void loop() {
            
float jarak = sonar.ping_cm();
          if (jarak < 70.00){
              lampu();
              if (jarak = 0.00 ){
                  lampuMti();
              }else{
                  jarak = sonar.ping_cm();
              }
                  delay(1000);                     
                      Serial.print("Distance: ");
                          Serial.print(jarak); 
                              Serial.println("cm");
                              } else {

                              lampuMti();
                              Serial.print("jauh dari 70");
                              }
                                  
                                      
                                          
                                          }