c#增量pid算法 增量pid算法 Kp = 0.4f; Ki = 0.53f; Kd = 0.1f; SetSpeed = a; err = SetSpeed - ActualSpeed; float incrementSpeed; incrementSpeed = Kp * (err - err_next + Ki