#include <Servo.h> //подключение библиотеки
Servo myservo; // создание объекта

float cm;
float inches;

// Функция чтения данных с датчика
long readUltrasonicDistance(int triggerPin, int echoPin)
{
  pinMode(triggerPin, OUTPUT); // сброс Trig
  digitalWrite(triggerPin, LOW);
  delayMicroseconds(2);
  digitalWrite(triggerPin, HIGH); // установка TRIG на 10 мкс
  delayMicroseconds(10);
  digitalWrite(triggerPin, LOW);
  pinMode(echoPin, INPUT); // измерение длительности ECHO
  return pulseIn(echoPin, HIGH);
}

void setup() {
  myservo.attach(9); // привязка линии управления к выводу 9
  Serial.begin(9600);
}
int distanceMax = 400;

void loop() {
  cm = readUltrasonicDistance(3, 2) / 58;

  int val = 180 - cm*180/distanceMax;
  myservo.write(val); // устанвока новой позиции сервопривода#
  delay(10);
}