added a bit more pseudo code for new auton routine