Дозатор отбора+клапан

#include <LiquidCrystal_I2C.h>
#include <Servo.h>
Servo Servo1;// Создаем объект
int x, y, z, meny = 1, otb = 0, f = 0, f1 = 0, in ; // Создаем переменную
int tmasPin = 6; // 6 pin внешнее управление 1 отбор открыт, 0 закрыт
LiquidCrystal_I2C lcd(0x27, 16, 2); // Устанавливаем дисплей

/////////////////////////////////////////////////////////////////////////
void setup() {
  Serial.begin(9600);
  pinMode(tmasPin, INPUT_PULLUP);//на вход подключен подтягивающий резистор
  Servo1.attach(13);      // 13 й пин привязываем сервопривод
  Servo1.writeMicroseconds(2250);//если серво стоит с другой стороны то надо Servo1.writeMicroseconds(700)
  //при включении закрываем клапан
  delay(700);
  Servo1.detach();
  lcd.init();
  lcd.backlight();// Включаем подсветку дисплея
  lcd.setCursor(11, 0);
  lcd.print("STOP ");
  delay (1000);
  //lcd.clear();
}
//////////////////////////////////////////////////////////////////////////
void loop() {
  in = digitalRead(tmasPin);
  delay(1000);//задерживаем следующую проверку на 1 сек
  if (in == LOW && Servo1.read() == f) { //проверяем вход управления 6 пин,и если 0 и отбор закрыт ничего не делаем.
    //Только раз 1 сек проверяем не поменялось ли состояние входа
    lcd.setCursor(11, 0);
    lcd.print("STOP ");
  }
  if (in == LOW && Servo1.read() != f) {//проверяем вход управления 6 пин, если 0, а отбор открыт закрываем
    Servo1.attach(13);//активируем серво
    Servo1.writeMicroseconds(2225);//закрываем
    //если серво стоит с другой стороны то  надо Servo1.writeMicroseconds(700)
    delay(700);//время на работу серво
    Servo1.detach();//деактивируем
    lcd.setCursor(11, 0);
    lcd.print("STOP ");
    f = Servo1.read();//читаем положение серво
    f1 = 0;//отменяем положение серво при откром клапане
  }
else {
  if (in == HIGH && Servo1.read() == f1) {//проверяем вход управления 6 пин,и если 1 и отбор открыт ничего не делаем
    //Только раз 1 сек проверяем не поменялось ли состояние входа
    lcd.setCursor(11, 0);
    lcd.print("OPEN ");
  }
  if (in == HIGH && Servo1.read() != f1) {
    Servo1.attach(13);
    Servo1.writeMicroseconds(2225 - otb);//открываем на установленный отбор
    //если серво стоит с другой стороны то  надо Servo1.writeMicroseconds(otb+700)
    delay(700);
    Servo1.detach();
    lcd.setCursor(11, 0);
    lcd.print("OPEN ");
    f1 = Servo1.read();
    f = 0;
  }
}
delay(700);
x = analogRead(0);
if (x < 200) {//если нажата кнопка "ОК" переходим в режим установки отбора
  lcd.clear();
  delay(1000);
  meny = 1;
  while (meny == 1) {//пока не нажата кнопка ОК выставляем Otbor
    lcd.setCursor(5, 0);
    lcd.print("OTBOR");
    lcd.setCursor(5, 1);
    lcd.print("    ");
    lcd.setCursor(5, 1);
    lcd.print(otb);
    Serial.println(otb);//вывод значение отбора на мотитор порта
    x = analogRead(0);
    z = analogRead(1);
    y = analogRead(2);
    if (y < 200)otb -= 50;//50 шаг установки значения
    if (z < 200)otb += 50;
    if (otb > 1400)otb = 1400;//установка максимального значения больше 1400 не ставится
    if (otb < 0)otb = 0;//установка минимального значения
    delay(100);
    if (x < 200) {//если нажата кнопка "ОК" устанавливаем отбор и выходим из режима установки отбора
      Servo1.attach(13);
      Servo1.writeMicroseconds(2250 - otb);// установлен заданный отбор
      //если серво стоит с другой стороны то  надо Servo1.writeMicroseconds(otb+700)
      delay(700);
      Servo1.detach();
      meny = 0;
    }
  }
}
}

/////////////////////////////////////////////////////////////////////////////////