Ну вот и нефиг делать "среднезаковыристые" алгоритмы
надо нормальные делать! При нормальных робот должен до 60% времени ехать на полном ходу, а остальное скажем на полуполном. А это значит будет средняя скорость порядка 0.6+0.2=0.8 от исходной, т.е. за 10-11-12 секунд роботы должны проходить трассу. А это 2-3 места сейчас. Вполне нормально для типовой платформы.
К тому же серва HXT900 если её предусмотреть даст 1.4 оборота в секунду, это значит робот пройдёт трассу за 7-8-9 секунд. И это при напряжении 4.8В, на 6В думаю вообще выдаст 1.75 об/сек, это уже 5.6-7.2сек на трассу.
Добавлено спустя 36 секунд:Сервы кормят импульсами как сервам. Чтобы драйвер двигателей не городить.