#define pTrig 4
#define pEcho 5
#define pinLED 6
#define pinBuzzer 7

long durasi;
int jarak;

void setup() {
  Serial.begin(9600);
  pinMode(pTrig, OUTPUT);
  pinMode(pEcho, INPUT);

  pinMode(pinLED, OUTPUT);
  pinMode(pinBuzzer, OUTPUT);
}

void loop() {
  digitalWrite(pTrig, HIGH);
  delayMicroseconds(10);
  digitalWrite(pTrig, LOW);

  durasi = pulseIn(pEcho, HIGH);
  jarak = ((durasi * 0.034)/2);

  if(jarak>200){
    digitalWrite(pinLED, HIGH);
    tone(pinBuzzer, 31);
    Serial.println("BAHAYA!");
    Serial.println("jarak: " + String(jarak) + " cm");    
    delay(1000);
  }
  else{
    digitalWrite(pinLED, LOW);
    noTone(pinBuzzer);
    Serial.println("AMAN!");
    Serial.println("jarak: " + String(jarak) + " cm");
    delay(1000);  
  }
}