|
|
@ -221,8 +221,8 @@ int32_t AP_RollController::get_rate_out(float desired_rate, float scaler) |
|
|
|
*/ |
|
|
|
*/ |
|
|
|
int32_t AP_RollController::get_servo_out(int32_t angle_err, float scaler, bool disable_integrator) |
|
|
|
int32_t AP_RollController::get_servo_out(int32_t angle_err, float scaler, bool disable_integrator) |
|
|
|
{ |
|
|
|
{ |
|
|
|
if (gains.tau < 0.1f) { |
|
|
|
if (gains.tau < 0.01f) { |
|
|
|
gains.tau.set(0.1f); |
|
|
|
gains.tau.set(0.01f); |
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
// Calculate the desired roll rate (deg/sec) from the angle error
|
|
|
|
// Calculate the desired roll rate (deg/sec) from the angle error
|
|
|
|