Разобрался. Но есть проблема. После выполненной команды, серво занимается определенное положение. Потом нужно отключить серву, для свободного перемещения рукой. Вот мой код)). Когда серва заняла позицию я её отключаю, даю время занять положение и отключаю, но при этом отключается сервер. Пока...