du kannst doch einfach indie fahr und dreh funktion, eine interrupt gesteuerte rücksetzten funktion einbauen. (genaueres zu interrups steht im Buch mehr spaß mit asuro.
dazu müstest du die asuro.h ein bischen modofizieren