Reformatted and commented Autonomous.h

Now it's more organized and should act the same way