der atmega16 langt für die aufgabe dicke.
verwende das hardware PWM für die ansteuerung der beiden Motoren oder regel die Schrittmotoren in einer der drei timer.
da kannst du bequem in der hauptschleife ein paar Sensoren abfragen.

grüße
flite