#include <Servo.h>
#define TRIG_PIN 10
#define ECHO_PIN 9
#define pinServo 5
Servo myServo;
long jarak;
float pos = 0.0;

//float readDistanceCM(){
 //digitalWrite(TRIG_PIN, LOW);
 //delay(1000);
 //digitalWrite(TRIG_PIN, HIGH);
 //delay (1000);
 //digitalWrite(TRIG_PIN, LOW);
 //int duration = pulseIn(ECHO_PIN, HIGH);
 //return duration * 0.034/2;
//}

void setup() {
    pinMode(TRIG_PIN, OUTPUT);
    pinMode(ECHO_PIN, INPUT);
    Serial.begin(115200);
    myServo.attach(5);
}

void loop() {
  digitalWrite(TRIG_PIN, LOW);
  delayMicroseconds(10);
  digitalWrite(TRIG_PIN, HIGH);
  delayMicroseconds(10);
  digitalWrite(TRIG_PIN, LOW);
  int jarak = pulseIn(ECHO_PIN, HIGH);
  if(digitalRead(jarak >= 1000)) {
    if(pos>0) {
        myServo.write(pos);
        pos -=90;
        //delay(1000);
      }
    }
  if(digitalRead(jarak <=100)) {
    if(pos<90){
        myServo.write(pos);
        pos +=90;
        delay(500);
      }
    }
}