Updated Autonomous mode code

Added multiple autonomous