Added adjustable autonomous

autonomous can now be changed with the use of 3 switches. also added
minor fixes for shooting and pickup