#include <Servo.h>
int PWM ;
Servo servo1;
long durasi,jarak;


void setup() {
pinMode(5,OUTPUT);
servo1.attach(5);
pinMode(2, OUTPUT);
pinMode(3, INPUT);
Serial.begin(115200);
}

void loop(){

digitalWrite(2,0);delayMicroseconds(2);
digitalWrite(2,1);delayMicroseconds(10);
digitalWrite(2,0);
durasi=pulseIn(3, HIGH);
jarak=(durasi/2)/29.1;
servo1.write(0);delay(1000);
servo1.write(180);delay(1000);
Serial.println (jarak); delay(1000);

}