https://github.com/wkunkel/422-robot...ms/Shooter.cpp
Here is our starting PID control system for our shooter. It has two wheels, with an encoder on each wheel. The encoder resolution is 256 ticks per revolution. This loop needs to be tuned (changing the P, I, and D constants), but it is functional starting code.