Кстати!!! А чё сидим? Кого ждем???
Надо срочно накидать АЛГОРИТМ работы управления движками в ПИД режиме.
Указываем процедуре на какой скорости и сколько тиков энкодера надо сделать. Имеем показания энкодера и имеем возможность менять скважность ШИМа.
Надо чтобы процедура сама подстраивала на ходу в не зависимости от напряжения питания и нагрузки на колесо.
Если процедура считает что выполнить не возможно, то пусть вернет код ошибки почему она не может этого сделать...
например, подаю 100% ШИМ а колесо не крутится, значит оно заблокированно.
или данную скорость набрать не возможно, потому как низкое напряжение, максимально возможно такое-то...