#include <Servo.h>

const int sensorIR = 7;
const int ledPin = 13;
const int trigPin = 6;
const int echoPin = 5;
Servo servoMotor;

long jarak;
long durasi;

void setup() {
  pinMode(sensorIR, INPUT);
  pinMode(ledPin, OUTPUT);
  pinMode(trigPin, OUTPUT);
  pinMode(echoPin, INPUT);
  
  servoMotor.attach(3);
  servoMotor.write(0);
  
  Serial.begin(9600);
}

void loop() {
  int statusSensorIR = digitalRead(sensorIR);

  if (statusSensorIR == 0) {
    digitalWrite(ledPin, HIGH);
    servoMotor.write(90); 
    delay(1000);
  }

  digitalWrite(trigPin, LOW);
  digitalWrite(trigPin, HIGH);
  digitalWrite(trigPin, LOW);

  durasi = pulseIn(echoPin, HIGH);

  jarak = durasi * 0.034 / 2;
  
  if (jarak > 50) { 
      servoMotor.write(0);
      digitalWrite(ledPin, LOW);
      delay(1000);
    }
  
}