Ohne jetzt etwas zu dem Code zu sagen: Schau Dir mal den Abschnitt über die Timer im Datenblatt des Controllers Deiner Wahl an - das ist genau das, was Du suchst.