Updating Autonomous

Getting the autonomous program ready to drive back to the rolling goals
to attempt to grab yet another goal.