int trig_pin = 2;
int echo_pin = 3;
long echotime;
float distance;
#include <Servo.h>

Servo myServo;

int pos = 0;



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);

  pinMode(13, OUTPUT);
  pinMode(12, OUTPUT);
  
  myServo.attach(9);

}

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.println("cm");
  delay(15);

  digitalWrite(13, HIGH);
  digitalWrite(12, LOW);
  delay(15);

  digitalWrite(13, LOW);
  digitalWrite(12, HIGH);
  delay(15);

  for(pos = 0; pos <= 180; pos += 1){
  myServo.write(pos);
  delay(15);
}
  
}