Использование обратной связи энкодера для управления 360 градусным сервоприводом

Я собрал скетч для управления сервоприводом, который вращает энкодер. В конце концов я планирую построить его до входа DMX, так что у меня есть диапазон входных данных от 0 до 255. По сути, он должен попросить вас ввести диапазон от 0 до 255, а затем изменить это значение на 0 -180 для сервоуправления. Затем он должен сравнить это с кодером и вращать правильное направление до тех пор, пока значение кодера и запрошенные значения не совпадут. Я только изучаю arduino, поэтому уверен, что совершил какую-то ошибку. Вот код:

// Входы поворотного энкодера
#define inputCLK 22
#define inputDT 24

#include <Servo.h>

Servo myservo;
int pos = 90;
int counter = 90; 
int currentStateCLK;
// Настройка последовательного монитора
   
// Считайте начальное состояние inputCLK
// Назначить переменной
int previousStateCLK; 
 
String encdir ="";

void setup() { 
  Serial.begin (9600);  
  previousStateCLK = digitalRead(inputCLK);
  // Установить контакты энкодера в качестве входов
  pinMode (inputCLK,INPUT);
  pinMode (inputDT,INPUT);
  myservo.attach(9);
    
void loop() { 
  Serial.println("Enter a number from 0 to 255");  
  while (Serial.available() == 0); {}  
  int val = Serial.parseInt(); // прочитайте int или parseFloat для ..float...
  long Pos = val;
  Pos = Pos * 180 / 255;
  Serial.println(val);
  Serial.println(Pos);
  if (Pos > Counter) {
    myservo.write 0;
  }
  if (Pos < Counter) {
    myservo.write 180;
  }
  if (Pos = Counter) {
    myservo.write 90;
  }

  // Считывание текущего состояния inputCLK
  currentStateCLK = digitalRead(inputCLK);
   
  // Если предыдущее и текущее состояния inputCLK различны, то произошел импульс
  if (currentStateCLK != previousStateCLK) { 
    // Если состояние inputDT отличается от состояния inputCLK, то 
    // кодер вращается против часовой
    if (digitalRead(inputDT) != currentStateCLK) { 
      counter --;
      encdir ="CCW";
    } else {
      // Энкодер вращается по часовой стрелке
      counter ++;
      encdir ="CW";       
    }
    Serial.print("Direction: ");
    Serial.print(encdir);
    Serial.print(" -- Value: ");
    Serial.println(counter);
  } 
  // Обновить previousStateCLK с текущим состоянием
  previousStateCLK = currentStateCLK; 
}

Поэтому, когда я запускаю программу, я не получаю никакого движения на сервоприводе.

Спасибо.