Modify PID control algorithm.
Change Kd in PID