Updated Autonomous Logic

New starting position for auton = new batch of code