#include <Servo.h>

Servo myservo;
int pos = 0;  

const int echoPin = 1;
const int trigPin = 2;
long duration;
int distance;


void setup() {
  myservo.attach(11);
  pinMode(trigPin, OUTPUT);
  pinMode(echoPin, INPUT);
  Serial.begin(9600);
  }

void loop() {
  digitalWrite(trigPin, LOW);
  delayMicroseconds(2);
  digitalWrite(trigPin, HIGH);
  delayMicroseconds(10);
  digitalWrite(trigPin, LOW);

  duration = pulseIn(echoPin, HIGH);
  distance = duration * 0.034 / 2;

  Serial.print("Jarak: ");
  Serial.println(distance);
  Serial.println(" cm");

  //while (distance <= 20) {
    //pos = pos - 10;
    //myservo.write(pos);
  //}

  //while (distance >= 20) {
    //pos = pos + 10;
    //myservo.write(pos);
  //}


  for (distance = 0; distance <= 20; pos += 10) {
     myservo.write(pos);             
     delay(15);          
  }     
    
  for (distance = 21; pos >= 180; pos -= 10) {
     myservo.write(pos);           
     delay(15);                      
  }
 }