Устройство, более похожее на мельницу, чем на робота

ИК дальномеры GP2Y0A02YK (2 горизонтальных, 2 вертикальных) засекают объект и "мельница" начинает следить за ним, изменяя направление и скорость вращения.
Шаговиками управляют два L298, за интелектуальную часть отвечает МК ATmega128.
На дисплей WC1602A выводятся индикация поиска/сопровождения цели, значения шагов горизонтали и вертикали (векторные координаты на цель), направление вращения двигателей.
Замечания: в режиме сопровождения "мельница" довольно заметно дергается, это результат частого реверса. Сигнал с ИК датчиков "скачет", даже усредненный. Но если поднести к датчикам руки, то "мельница" уверенно следует за "руководством"
