diff --git a/src/main/flight/gps_rescue.c b/src/main/flight/gps_rescue.c index 3a61f2500..a96ade1fe 100644 --- a/src/main/flight/gps_rescue.c +++ b/src/main/flight/gps_rescue.c @@ -192,7 +192,6 @@ bool magForceDisable = false; static bool newGPSData = false; rescueState_s rescueState; -altitudeMode_e altitudeMode; throttle_s throttle; /* @@ -602,16 +601,17 @@ void updateGPSRescueState(void) newDescentDistanceM = gpsRescueConfig()->descentDistanceM; } - switch (altitudeMode) { - case MAX_ALT: - newAltitude = MAX(gpsRescueConfig()->initialAltitudeM * 100, rescueState.sensor.maxAltitudeCm + 1500); - break; + switch (gpsRescueConfig()->altitudeMode) { case FIXED_ALT: newAltitude = gpsRescueConfig()->initialAltitudeM * 100; break; case CURRENT_ALT: newAltitude = rescueState.sensor.currentAltitudeCm; break; + case MAX_ALT: + default: + newAltitude = MAX(gpsRescueConfig()->initialAltitudeM * 100, rescueState.sensor.maxAltitudeCm + 1500); + break; } //Calculate angular coefficient and offset for equation of line from 2 points needed for RESCUE_LANDING_APPROACH