Added delay

The delay-function is currently in main.c, for testing purpose. Not sure how exact the delay is, has only tested with a timer and not an oscilloscope. But it seems accurate...
Merge branch 'mcu_timers_temp' into mcu_timers