* Add watchdog code * Add file structure for safety controller * Lay groundstones to move all error flags to the safety controller * Improve doxygen