#include <Servo.h>

#define echoPin 2
#define trigPin 3

int maximumRange = 300;
int minimumRange = 0;
long duration, distance;
Servo myServo;

void setup() {
  Serial.begin(9600);
  pinMode(trigPin, OUTPUT);
  pinMode(echoPin, INPUT);
  
  // Pin LED
  pinMode(9, OUTPUT);  
  pinMode(10, OUTPUT); 
  pinMode(11, OUTPUT); 
  
  myServo.attach(3); 
}

void loop() {
  
  digitalWrite(trigPin, LOW);
  delayMicroseconds(2);
  digitalWrite(trigPin, HIGH);
  delayMicroseconds(10);
  digitalWrite(trigPin, LOW);
  duration = pulseIn(echoPin, HIGH);

  
  distance = duration / 58.2;

 
  if (distance >= maximumRange || distance <= minimumRange) {
    Serial.println("Di Luar Jangkauan");
  } else {
    
    Serial.print("Jarak : ");
    Serial.print(distance);
    Serial.println(" cm ");
    delay(100);
  }


  if (distance <= 10) {
    digitalWrite(11, HIGH); 
    digitalWrite(10, LOW);  
    digitalWrite(9, LOW);   
    myServo.write(0);       
  }
  else if (distance > 10 && distance < 20) {
    digitalWrite(11, LOW);  
    digitalWrite(10, HIGH); 
    digitalWrite(9, LOW);   
    myServo.write(90);      
  }
  else if (distance >= 20) {
    digitalWrite(11, LOW);  
    digitalWrite(10, LOW);  
    digitalWrite(9, HIGH);  
    myServo.write(180);     
  }
}