Das mit dem Sortieren habe ich nicht verstanden. Bei den ISR routinen ist noch ein Fehler drinn:
Am anfang der ISR Routine muß man das Porzessor status register sichern, sonst werden die Flags für das Hauptprogramm geändert. Ähnlich muß man entweder seperate Register für die ISR routinen nehmen oder die Register vorher retten.