Cleanup autonomous code
Merge branch 'master' of https://github.com/FRCTeam1719/2014Robot