/*
*Pintu Palang Otomati 
*script By:Dicky
*/
#include servo.h
#define MAX_DISTANCE 500
Servo servo;
int pinTrigger= 12;
int pinEcho= 13;
int pinHijau= 10;
int pinMerah= 11;
float durasi, jarak;
void setup()
 {
 pinMode(pinTrigger. OUTPUT);
 pinMode(pinECHO, INPUT);
 pinMode(pinHijau, OUTPUT);
 pinMode(pin Merah, OUTPUT);
  Serial.begin(9600);
 servo.attach(9);
}

void loop() 
{
//program trigger memancarkan ultrasonik 
digitalWrite(pinTrigger, LOW);
delayMicroseconds(2);
digitalWrite(pinTrigger, HIGH);
delayMicroseconds(10);
digitalWrite(pinTrigger, LOW);

durasi = pulseIn(pin ECHO, HIGH);
jarak = (durasi*0.034)/2;

Serial.print(jarak);
Serial.println("CM");
if(jarak<= 6);
{
digitalWrite(pinMerah., LOW);

digitalWrite(pinHijau, HIGH);
servo.Write(90);//posisi servo 90 derajat
delay(100);
}
else
{
  digitalWrite(pinHijau,LOW);//led hijau mati
  digitalWrite(pinMerah, HIGH);//led merah nyala
  servo.Write(0);//posisi servo 0 derajat
}
  delay(450);
}