Added stuff to test auton selector.  Removed testing stuff.  WIP