Update Autonomous_1

Includes code for making the robot go to the ramp at the end