/**
   HC-SR04 Distance Sensor Example
   https://wokwi.com/arduino/projects/304444938977804866
*/

#include <Servo.h>
#define PIN_TRIG 3
#define PIN_ECHO 2

Servo myservo;

void setup() {
  myservo.attach(5);
  Serial.begin(115200);
  pinMode(PIN_TRIG, OUTPUT);
  pinMode(PIN_ECHO, INPUT);
}

void loop() {
  // Start a new measurement:
  digitalWrite(PIN_TRIG, HIGH);
  delayMicroseconds(10);
  digitalWrite(PIN_TRIG, LOW);

  // Read the result:
  int duration = pulseIn(PIN_ECHO, HIGH);
  Serial.print("Distance in CM: ");
  Serial.println(duration / 58);
  Serial.print("Distance in inches: ");
  Serial.println(duration / 148);

  int jarak = duration / 58;
  myservo.write(0);
  if(jarak>200)
  {
    myservo.write(0);
    delay(500);
  }
  else (jarak<200);
  {
    myservo.write(90);
    delay(200);
  }

}