Turn the current robot code into a command based robot

[joshbressers]

The current robot code is the timed robot, we need to turn this robot into a command based robot

[gldeA]

I would like to note that it would be simpler to write new command based code rather than relying on porting the old code, it won't translate over very well.

[joshbressers]

@gldeA I don't think there will be issues with a rewrite. We just want command based code to work on the current robot so we can learn from it