mirror of https://github.com/ArduPilot/ardupilot
Altitude hold bug fix - changed g.throttle_cruise to be updated to steal I term from correct controller
This commit is contained in:
parent
b30387bc5b
commit
0aac828eeb
|
@ -1280,14 +1280,14 @@ adjust_altitude()
|
||||||
// we remove 0 to 100 PWM from hover
|
// we remove 0 to 100 PWM from hover
|
||||||
manual_boost = g.rc_3.control_in - 180;
|
manual_boost = g.rc_3.control_in - 180;
|
||||||
manual_boost = max(-120, manual_boost);
|
manual_boost = max(-120, manual_boost);
|
||||||
g.throttle_cruise += g.pi_alt_hold.get_integrator();
|
g.throttle_cruise += g.pi_throttle.get_integrator();
|
||||||
g.pi_alt_hold.reset_I();
|
g.pi_alt_hold.reset_I();
|
||||||
g.pi_throttle.reset_I();
|
g.pi_throttle.reset_I();
|
||||||
|
|
||||||
}else if (g.rc_3.control_in >= 650){
|
}else if (g.rc_3.control_in >= 650){
|
||||||
// we add 0 to 100 PWM to hover
|
// we add 0 to 100 PWM to hover
|
||||||
manual_boost = g.rc_3.control_in - 650;
|
manual_boost = g.rc_3.control_in - 650;
|
||||||
g.throttle_cruise += g.pi_alt_hold.get_integrator();
|
g.throttle_cruise += g.pi_throttle.get_integrator();
|
||||||
g.pi_alt_hold.reset_I();
|
g.pi_alt_hold.reset_I();
|
||||||
g.pi_throttle.reset_I();
|
g.pi_throttle.reset_I();
|
||||||
|
|
||||||
|
|
Loading…
Reference in New Issue