Competition Fixes- South Florida Regional FINAL

New autonomous code, large number of other bugfixes and improvements.
Final planned release, code is considered stable.
Merge pull request #13 from stealthtigers3164/beta

Competition Fixes- South Florida Regional FINAL