Added Driver Station Features

This commit fills in some of the previously missing modes for the robot (Autonomous and Test). It also adds the ability to perform a soft reboot.

Another change, which works well for us with C++ but should be tested by other teams using different setups, is to detect Robot Code and send that as part of the emitted robotData.