diff --git a/ArduCopter/ArduCopter.pde b/ArduCopter/ArduCopter.pde index 3e28b5f8f8..0e49aa3b94 100644 --- a/ArduCopter/ArduCopter.pde +++ b/ArduCopter/ArduCopter.pde @@ -1835,7 +1835,7 @@ bool set_throttle_mode( uint8_t new_throttle_mode ) set_new_altitude(current_loc.alt); // by default hold the current altitude if ( throttle_mode <= THROTTLE_MANUAL_TILT_COMPENSATED ) { // reset the alt hold I terms if previous throttle mode was manual reset_throttle_I(); - set_accel_throttle_I_from_pilot_throttle(); + set_accel_throttle_I_from_pilot_throttle(get_pilot_desired_throttle(g.rc_3.control_in)); } throttle_initialised = true; break; diff --git a/ArduCopter/Attitude.pde b/ArduCopter/Attitude.pde index a944af959f..3b0e2acdd1 100644 --- a/ArduCopter/Attitude.pde +++ b/ArduCopter/Attitude.pde @@ -1195,10 +1195,10 @@ static void reset_throttle_I(void) g.pid_throttle_accel.reset_I(); } -static void set_accel_throttle_I_from_pilot_throttle(void) +static void set_accel_throttle_I_from_pilot_throttle(int16_t pilot_throttle) { // shift difference between pilot's throttle and hover throttle into accelerometer I - g.pid_throttle_accel.set_integrator(g.rc_3.control_in-g.throttle_cruise); + g.pid_throttle_accel.set_integrator(pilot_throttle-g.throttle_cruise); } static void reset_stability_I(void)