Competition Fixes- South Florida Regional FINAL

New autonomous code, large number of other bugfixes and improvements.
Final planned release, code is considered stable.