Пример constant speed
Забудьте про millis и про библиотеку.
Напишите по-русски, как бы Вы сами решали эту задачу, окажись Вы на месте микроконтроллера.
Спасибо большое за подсказку, так работает. Осталось сделать вывод на дисплей, понимаю уже вопрос не по теме, но пока не буду закрывать тему.
Всем спасибо. Сделал как советовал sadman41. И вывод на дисплей 320*240 через библиотеку UTFT.