More refactoring

Added back in RobotDrive() for joystick control so that the production
robot could be tested today.