Fixes error with PID controller.  Derivative term was not being multiplied by kd