Hallo,
erstmal vielen Dank für eure Anregungen. Ich habe später selbst bemerkt das nur ein UP da ist, wie the_Ghost erkannt hat. Bin irgendwie mit goto und call durcheinander gekommen. Habe mir auch schon gedacht mittels dem TMR0 ein UP zu schreiben das einfach mal länger mal kürzer "zählt" Mal sehen ob ich dass so hinbekomme.

Auf jeden Fall DANKE an alle die mitgedacht haben!!!!