Changes from Hawaii Regional

Improved autonomous for both driving and shooting
More parameterized commands to facilitate re-use in autonomous