Und auch den gesamten Code zeigen, denn warum bist du dir sicher das der Fehler gerade in dem Bereich liegt. Man sieht z.B. nicht ob du sei(); gesetzt hast.
Es wäre ausserdem Übersichtlicher und vom Code her kürzer, wenn du den OutputComparematch Interrupt benutzen würdest.