PID控制算法的计算方程式为：

u(t) = Kp e(t) + Ki ∫e(t)dt + Kd * de/dt