Ha, ich habs inzwischen doch gefunden.
Purer Zufall, aber falls jemand mal knobeln will...

Der Programmcode selber ist richtig, eigentlich ist es einfach wenn man ISRs öfter verwendet.