PID controller formula equation: u(t) = Kp e(t) + Ki integral e(tau) dtau + Kd de(t)/dt