@@ -230,7 +230,7 @@ public class PidLambdaV2Container {
lastError = error;
lastPidValue=kp * error + ki * integral + kd * derivative;
double result=currentValue+lastPidValue;
- double min=setPoint>currentValue?currentValue:setPoint;
+ double min=setPoint>lambda?lambda:setPoint;
if(result<=min/8d){
result=min/8d;
}