[zbanks]

What language are you using?

From experience, I know C++ & Java have the built-in PIDController class to do the computation for you.

Although it's always better to know how things work, the time constraints limit your debug time. The class is pretty easy to use, and its used in a few of the examples. Spend your time tuning the loop instead of debugging math.

Good luck!