Fixes for competition backup
Should be ready for Cleveland. Needs to be Tested.
COMPETITION CODE
Added autonomous shooting UNTESTED
added a printf