Cleaned up Autonomous.cpp

Made no changes to operation but cleaned up if statements and the setting of variables in constructor. @Anidev even though that works its still wrong.