Modbus+Servo

[Dwail]

Пытаюсь управлять сервоприводом через modbus.
Идея такая: на мастере нажимаем кнопку (притянута к земле), считаем количество нажатий, умножаем на 10, и поворачиваем серву на слейве на полученную величину.
В результате серва постоянно дергается на угол 5-10 град, и иногда проскакивает управляющий сигнал, поворачивающий ее на "правильный угол".
Если ту же серву подключить без modbus, то работает отлично.
Во вложении полная версия программы (управление двигателями 3шт и управление подсветкой)