Try to make some of the old code compile and add some more commands
Merge branch 'master' of https://github.com/HarkerRobo/RobotCode-2015