#include <Servo.h>
Servo myServo;
int trigPin =3;
int echoPin =4;
int led = 7;
int sudut = 0;
int servoPin = 2;

void setup() {
  myServo.attach(servoPin);
  pinMode(led, OUTPUT);
  pinMode(trigPin, OUTPUT);
  pinMode(echoPin, INPUT);
  Serial.begin(9600);

}
float distance_cm () {
  digitalWrite(trigPin, LOW);
  delayMicroseconds(2);

  digitalWrite(trigPin, HIGH);
  delayMicroseconds(10);

  int duration = pulseIn(echoPin, HIGH);
  return (duration / 2)  / 29 ;
}

void loop() {
  
  float cm = distance_cm();

  if (cm <= 150) {
    sudut = 90;
    myServo.write(sudut);
    delay(1000);
    digitalWrite(led, HIGH);
  } else {
    sudut= 0;
    myServo.write(sudut);
    delay(1000);
    digitalWrite(led, LOW);
  }
  Serial.print("Jarak Benda: ");
  Serial.print(cm);
  Serial.print(" cm");
  Serial.print(" ");

}