#include <Servo.h>
Servo servo;

//define dari sensor ultrasonic
const int TRIG_PIN = 2;
const int ECHO_PIN = 3;

//define sensor ke 2
const int TRIG_PIN2=5;
const int ECHO_PIN2=6;

//define LED merah di pin 7
const int LED=7;

long echotime; 

int jarak=0;

void setup()
{
  servo.attach(4); 
  
  Serial.begin(9600);
  pinMode(TRIG_PIN, OUTPUT);
  pinMode(ECHO_PIN, INPUT);
  digitalWrite(TRIG_PIN, LOW);

  pinMode(TRIG_PIN2, OUTPUT);
  pinMode(ECHO_PIN2, INPUT);
  digitalWrite(TRIG_PIN2, LOW);

  digitalWrite(LED,OUTPUT);
}

void loop()
{
  digitalWrite(TRIG_PIN, HIGH);
  delayMicroseconds(10);
  digitalWrite(TRIG_PIN, LOW);
  
  echotime = pulseIn(ECHO_PIN, HIGH);
  
  jarak = 0.034 * echotime / 2; 
  Serial.print("Jarak: ");
  Serial.print(jarak);
  Serial.println(" cm");

  if (jarak < 20) 
  {
    servo.write(90);
  } else 
  {
    servo.write(0); 
  }

  delay(500); 
}

//kodingan inti sensor 
{
  digitalWrite(TRIG_PIN2, HIGH);
  delayMicroseconds(10);
  digitalWrite(TRIG_PIN2, LOW);
  echotime = pulseIn(ECHO_PIN2, HIGH);
  jarak=0.0001*((float)echotime*340.0)/2.0;

  //print hasi; bacaan selalui serial monitor
  Serial.print("Jarak: ");

  if (jarak <=10) 
  {
    digitalWrite(LED, HIGH);
    delay(2000);
  }
   else 
  {
    digitalWrite(LED, LOW);
    delay(2000);
  }
}