@@ -233,6 +233,9 @@ public class PidLambdaForCpcContainer {
}
double derivative = (error - lastError) / 1; // 假设采样间隔为1
lastError = error;
+ if(lambda<0){
+ lambda=setPoint;
+ }
return lambda+kp * error + ki * integral + kd * derivative;