Ja das klingt doch nach einer guten Idee mit dem Inlining. Dann bleibt der Code wenigstens an beiden Stellen gleich.

Der Force Output Compare ("FOC" siehe oben) löst leider keinen Interrupt aus...
Gruß