Ich würde Dir folgendes vorschlagen:

1.Mit Timer Interuppt arbeiten
2.Deine Variable 16 Bit breit machen (wegen Überlauf)

MfG
Ruedi