The old code boots with the new RTOS.

Still needs testing on real robot.