Кстати!!! А чё сидим? Кого ждем??? Надо срочно накидать АЛГОРИТМ работы управления движками в ПИД режиме. Указываем процедуре на какой скорости и сколько тиков энкодера надо сделать. Имеем показания энкодера и имеем возможность менять скважность ШИМа. Надо чтобы процедура сама подстраивала на ходу в не зависимости от напряжения питания и нагрузки на колесо. Если процедура считает что выполнить не возможно, то пусть вернет код ошибки почему она не может этого сделать... например, подаю 100% ШИМ а колесо не крутится, значит оно заблокированно. или данную скорость набрать не возможно, потому как низкое напряжение, максимально возможно такое-то...
Я смотрю желающих написать алгоритм аж очередь выстроилась... Никто не умеет или не просто никто не знает что такое ПИД-регулирование??? Или это только мне одному нужно???
Если в текстовом: 1 Задаем равные коэффициенты заполнения по каналам обоих колес 2 Ждем фронт сигнала с правого энкодера 3 Засекаем время до следующего фронта 4 Ждем фронт сигнала с левого энкодера 5 Засекаем время до следующего фронта (Пункты 2, 3 и 4, 5 выполняются параллельно) 6 Сравниваем временные интервалы если интерал между правыми фронтами больше интервала между левыми уменьшаем коэффициент заполнения по каналу левого колеса 7 Если интерал между правыми фронтами меньше интервала между левыми увеличиваем коэффициент заполнения по каналу левого колеса 8 Возвращаемся к пункту 2
Если нужна графика нарисую часов через 6 (сейчас на работе)