#include <Servo.h>


//Mendefinisikan pin pada ultrasonic sensor
const int trigPin = 9;
const int echoPin = 10;

Servo myservo;

// Variable
long duration;
int distance;

void setup() {
  // Initialize serial communication
  Serial.begin(9600);

  // Set trigPin sebagai OUTPUT dan echoPin sebagai INPUT
  pinMode(trigPin, OUTPUT);
  pinMode(echoPin, INPUT);
  //For servo
  myservo.attach(11);  // attaches the servo on pin 11 to the servo object
}

void loop() {
  // Clear trigPin nya
  digitalWrite(trigPin, LOW);
  delayMicroseconds(2);

  // Send a pulse to the sensor
  digitalWrite(trigPin, HIGH);
  delayMicroseconds(10);
  digitalWrite(trigPin, LOW);

  // Measure the duration of the pulse on echoPin
  duration = pulseIn(echoPin, HIGH);

  // Calculate distance in centimeters
  distance = duration * 0.034 / 2;

  // Print distance to serial monitor
  Serial.print("Distance: ");
  Serial.print(distance);
  Serial.println(" cm");

  // Check if object is within a certain range (e.g., 20 cm)
  if (distance > 0 && distance <= 10) {
    // Object detected
    digitalWrite(ledPin, HIGH);
  } else {
    // Object not detected
    digitalWrite(ledPin, LOW);
  }

  // Delay before next measurement
  delay(500);

}

int pulse, inches, cm;
    digitalWrite(Trig_Pin,LOW);
    delayMicroseconds(2);
    digitalWrite(Trig_Pin, HIGH);
    delayMicroseconds(10);
    digitalWrite(Trig_Pin, LOW);
    pulse = pulseIn(echo_Pin, HIGH);
    cm = pulse * 0.034 / 2;
    inches = cm * 2.54;