Implemented mode startup code.

Includes watchdog additions ;D