#include <Servo.h>
Servo myServo;

int pos = 0;
int trig_pin = 2;
int echo_pin = 3;

long echotime;
float distance;

void setup() {
  // put your setup code here,to run once:
  Serial.begin(9600);

  pinMode(trig_pin, OUTPUT);
  pinMode(echo_pin, INPUT);
  digitalWrite(trig_pin, LOW);

  myServo.attach(9);


  pinMode(12, OUTPUT);
}

void loop() {
   // put your main code here, to run repeatedly:
   digitalWrite(trig_pin, HIGH);
   delayMicroseconds(10);
   digitalWrite(trig_pin, LOW);

   echotime = pulseIn(echo_pin, HIGH);
   distance = 0,0001*((float)echotime*340.0)/2.0;

   Serial.print(distance);
   Serial.print("cm");
   delay(15);

    for (pos = 0; pos <=180; pos += 1){
      myServo.write(pos);
      digitalWrite(12, HIGH);
      digitalWrite(13, LOW);
      delay(15);
      delay(15);
    }
    for (pos = 0; pos >= 0; pos -=1){
    myServo.write(pos);
    digitalWrite(12, LOW);
    digitalWrite(13, HIGH);
    delay(15);
    delay(15);
    }
}