#define TRIGGER 1
#define ECHO 2
#define SERVO 0

void setup() {
  pinMode(TRIGGER, OUTPUT);
  pinMode(ECHO, INPUT);
}

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

  long duration = pulseIn(ECHO, HIGH);
  long distance = duration * 0.017;

  digitalWrite(0, HIGH);
  delayMicroseconds(100 + distance / 4);
  digitalWrite(0, LOW);

  // servo_1.write((double)(max(distance, 50) * (180. / 50)));
}