Reorganized Autonomous

Several pieces of code happen no matter whether the goal is hot or cold — no need to retype them (and introduce inconsistencies and errors). Better to have them as separate methods.

Signed-off-by: Seth Battis <SethBattis@stmarksschool.org>