Du hast verschiedene Timer, die Interrupts auslösen können. Somit kannst du Zähler bauen die bei einem Interrupt hochzählen und darauf reagieren.

PS: Codes bitte mit Codetags versehen.

MfG Hannes