Get the Harvester working.
Fix the RobotDrive to disable motor safety when in test mode and put it back after.