diff --git a/src/main/flight/altitudehold.c b/src/main/flight/altitudehold.c index b13a07fc3..e1be99631 100644 --- a/src/main/flight/altitudehold.c +++ b/src/main/flight/altitudehold.c @@ -89,10 +89,10 @@ static void applyMultirotorAltHold(void) // multirotor alt hold if (rcControlsConfig->alt_hold_fast_change) { // rapid alt changes - if (ABS(rcCommand[THROTTLE] - initialThrottleHold) > rcControlsConfig->alt_hold_deadband) { + if (ABS(rcData[THROTTLE] - initialThrottleHold) > rcControlsConfig->alt_hold_deadband) { errorVelocityI = 0; isAltHoldChanged = 1; - rcCommand[THROTTLE] += (rcCommand[THROTTLE] > initialThrottleHold) ? -rcControlsConfig->alt_hold_deadband : rcControlsConfig->alt_hold_deadband; + rcCommand[THROTTLE] += (rcData[THROTTLE] > initialThrottleHold) ? -rcControlsConfig->alt_hold_deadband : rcControlsConfig->alt_hold_deadband; } else { if (isAltHoldChanged) { AltHold = EstAlt; @@ -102,9 +102,9 @@ static void applyMultirotorAltHold(void) } } else { // slow alt changes, mostly used for aerial photography - if (ABS(rcCommand[THROTTLE] - initialThrottleHold) > rcControlsConfig->alt_hold_deadband) { + if (ABS(rcData[THROTTLE] - initialThrottleHold) > rcControlsConfig->alt_hold_deadband) { // set velocity proportional to stick movement +100 throttle gives ~ +50 cm/s - setVelocity = (rcCommand[THROTTLE] - initialThrottleHold) / 2; + setVelocity = (rcData[THROTTLE] - initialThrottleHold) / 2; velocityControl = 1; isAltHoldChanged = 1; } else if (isAltHoldChanged) { @@ -145,7 +145,7 @@ void updateAltHoldState(void) if (!FLIGHT_MODE(BARO_MODE)) { ENABLE_FLIGHT_MODE(BARO_MODE); AltHold = EstAlt; - initialThrottleHold = rcCommand[THROTTLE]; + initialThrottleHold = rcData[THROTTLE]; errorVelocityI = 0; altHoldThrottleAdjustment = 0; } @@ -162,7 +162,7 @@ void updateSonarAltHoldState(void) if (!FLIGHT_MODE(SONAR_MODE)) { ENABLE_FLIGHT_MODE(SONAR_MODE); AltHold = EstAlt; - initialThrottleHold = rcCommand[THROTTLE]; + initialThrottleHold = rcData[THROTTLE]; errorVelocityI = 0; altHoldThrottleAdjustment = 0; }