Updated AutonomousCode() and minor changes