Drehzahlmesser mit Atmega 16 + Gegenkopplung

hallo Leute!!

ich bin dabei hobbymässig eine Schwingeding zu bauen... 2 Stäbe welche 
in der Mitte mit einem Motor verbunden und am oberen Stab auffgehängt 
sind. Durch abwechselndes Drehen des motors sollte sich das Teil 
aufschwingen und maybe sogar in aufrechter Position zum stehen kommen.
nun hab ich folgendes Problem:

Als Motor verwende ich einen Schrittmotor mit Drehzahlgeber...
Dieser Drehzahlgeber liefert mir 2 Signale (Rechtecksignale +5V), eines 
davon leg ich an den INT0 Eingang des Atmega16 an. Nun möchte ich den 
Atmega so programmieren... jedesmal wenn eine Flanke kommt, und in 
welche Richtung sich der Motor dreht, soll die Variable "Temp" ihren 
Wert erhöhen oder veringern... aber irgendwie haut es noch nicht ganz 
hin... Dies brauch ich zum einen um die Bewegung grafisch in einer GUI 
auszugeben, aber auch um einen Selbstschutz zu programmieren. Denn wenn 
das Teil zu schnell schwingt soll es nicht zusammenklappen und sich 
selbst beschädigen.

hoffe jemand kann mir bei dem kleinen Problem helfen, vielen Dank schon 
im Voraus.

Ps.: im anhang habt ihr den quellcode