Hallo Jeronnimo,
für meine Routine brauchst du einen freien, externen Interrupt Eingang.
Wenn du den hast, dann gib mir mal den Portx.y, deinen µC und Frequenz, mit der er läuft.
Ich passe dir dann die Config an und stelle den Code ein.
Außerdem benutze ich einen durchlaufenden Allzweck-Timer, der mit 8KHz überläuft.

Gruß

Rolf