Changed names and added switchServo() method
Removed static reference to RobotDrive.  Will change back later today when I static-ify everything.