если не для обучения, тогда такой код абсолютно бесполезная жесть. допустим решишь сделать следующий шаг, например сразу управлять двумя сервами. да тоже движение "шаг" повторить, только уже регулируя скорость потенциометром или меняя значение переменной через уарт. самому пока осилить будет сложно, опять кто-то код делать будет? ладно, возможно сделают. решишь изменить само движение или несколько движений реализовать. опять кто-то делать будет и толку опять 0? программировать не научишся, а кто-то уже три раза заново код делать будет и в итоге этот код опять ничего полезного делать не будет. потом история опять и опять будет повторяться и кто сказал, что не нужно будет всё с нуля переписывать? а то, что одно и тоже движение может делаться кардинально разными алгоритмами, это еще не осознаёшь? был у тебя такой код
http://roboforum.ru/forum10/topic15622-105.html#p333202, ну да, вроде внешне клешня двигается как надо, а на деле такой код совершенно бесполезный для задачи в общем.
вроде не маленький, а пока какой-то цирк получается. если Vadimi4 или кто ещё согласится весь код написать, так вы хоть подетальней проработайте, что бы код сразу начинать писать с прицелом на решение задачи, а не клепание с нуля бесполезных примерчиков.