Fix broken anti windup if the proportional gain runs into the nonlinear area and gets clipped.
Also fix the wrong debug message.
This commit is contained in:
parent
f4f784a514
commit
c55874d70e
1 changed files with 2 additions and 2 deletions
|
@ -615,7 +615,7 @@ void FGPISimpleController::update( double dt ) {
|
|||
<< " error = " << error
|
||||
<< endl;
|
||||
|
||||
double prop_comp = error * Kp.get_value();
|
||||
double prop_comp = clamp(error * Kp.get_value());
|
||||
int_sum += error * Ki.get_value() * dt;
|
||||
|
||||
|
||||
|
@ -628,7 +628,7 @@ void FGPISimpleController::update( double dt ) {
|
|||
<< " int_sum = " << int_sum << endl;
|
||||
|
||||
set_output_value( clamped_output );
|
||||
if ( debug ) cout << "output = " << output << endl;
|
||||
if ( debug ) cout << "output = " << clamped_output << endl;
|
||||
}
|
||||
}
|
||||
|
||||
|
|
Loading…
Reference in a new issue