Initial steps of rewriting the PID stuff with actual Proportional, Integral, and Derivitive components.