I added code for the Angle motors that change the angle of the shooter. I added code that will control the speed of the shooter motors. Both is untested.
Initilized all the motors and servos