Added Autonomous code

Added last year's final code from the end of Worlds