#include <Servo.h>
Servo servo1;

int pinTRIG = 13;
int pinECHO = 12;
int pinTRIG2 = 11;
int pinECHO2 = 10;
int pinLED = 8;
int pinLED2 =5;
long duration, distance;

void setup() {
pinMode(pinLED, OUTPUT);
pinMode(pinLED2, OUTPUT);
pinMode(pinECHO, INPUT);
pinMode(pinTRIG, OUTPUT);
pinMode(pinECHO2, INPUT);
pinMode(pinTRIG2, OUTPUT);
servo1.attach(6);
}

void loop() {
//Program agar Trig mengirim sinyal ultrasonik
  digitalWrite(pinTRIG, LOW);
  delayMicroseconds(5);
  digitalWrite(pinTRIG, HIGH);
  delayMicroseconds(5);
  digitalWrite(pinTRIG, LOW);
  delayMicroseconds(5);
 
  duration = pulseIn(pinECHO, HIGH); 
  distance = (duration/2)/29.1; 
 
  if(distance<=100){
    servo1.write(90);
  }else{
    servo1.write(0);
  }
digitalWrite(pinTRIG2, LOW);
  delayMicroseconds(5);
  digitalWrite(pinTRIG2, HIGH);
  delayMicroseconds(5);
  digitalWrite(pinTRIG2, LOW);
  delayMicroseconds(5);

  duration = pulseIn(pinECHO2, HIGH); 
  distance = (duration/2)/29.1; 

  if(distance<=100){
    digitalWrite(pinLED, HIGH);
    delay(3000);
    digitalWrite(pinLED, LOW);
    digitalWrite(pinLED2, HIGH);
    delay(2000);
    digitalWrite(pinLED2, LOW);
    digitalWrite(pinLED, HIGH);
    delay(3000);
    digitalWrite(pinLED, LOW);
    digitalWrite(pinLED2, LOW);
    delay(5000);
  }else{
    digitalWrite(pinLED, LOW);
    digitalWrite(pinLED2, LOW);
  }
}