Tweaked Autonomous

Added some functionality to Autonomous.h