PID stuff working and kicker testable

got PID control working for various pivot tasks and have a bunch of code
ready for testing the kicker
PID and auto control stuff

Got lots of the functions like auto-fire and auto-pickups working. also
smoothed out manual control of the neck.