Some polishing prior to the first competition.

Still need to create .hex files for competition. Lots of changes were already merged in from the autonomous branch.