Multi-function Shield, потенциометр и сервомотор

//подключаем необходимые библиотеки для работы MultiFuncShield
#include <TimerOne.h>
#include <Wire.h>
#include <MultiFuncShield.h>
#include <SoftwareServo.h> //подключаем библиотеку сервомотора

SoftwareServo myservo;  // создать серво-объект myservo для управления сервоприводом 
 
int potpin = 0;  // Присваиваем имя potpin аналоговому выводу А0, к которому подключена средняя ножка потенциометра 
int val;     // переменная считывания данных с аналогового входа
int ugol;     // переменная для хранения угла поворота сервы
 
void setup() 
{ 
  Timer1.initialize();
  MFS.initialize(&Timer1);    // инициализация multi-function shield library
  myservo.attach(9);  // Подключаем цифровой вывод (pin 9) к сервомотору 
  Serial.begin(9600);  
} 
 
void loop() 
{ 
  val = analogRead(potpin);  // считывает значение потенциометра (значение от 0 до 1023) 
  ugol = map(val, 0, 1023, 0, 180);// преобразуем его, чтобы использовать его с серво (значение от 0 до 180)
  myservo.write(ugol); // устанавливаем положение сервопривода в соответствии с преобразованным значением в угол поворота
  Serial.println (myservo.read()); //отправляем в порт монитора значение угла поворота с сервомотора
  MFS.write(myservo.read()); //отправляем значение угла поворота серво на дисплей  
  delay(15);  // ждем, когда сервопривод отработает команду 
 
  SoftwareServo::refresh(); //команда обновления сервопривода, каждые 50 мс.
}