setzt mal den code rein damit man sehen kann wie weit du bist.
ansonsten sieh dir die timer funktion an und externen interuppt