Competition autonomous code

Initial commit of competition autonomous code.