Debugging Autonomous, has not been run on the robot, vision is working