From 98d6105592b6ac46cd04acddb563449285b53b27 Mon Sep 17 00:00:00 2001
From: Nicola De Pasquale <ndp7c7c0@gmail.com>
Date: Wed, 23 Oct 2019 22:54:33 +0200
Subject: [PATCH] add altitude mode setting to msp

---
 src/main/msp/msp.c | 4 +++-
 1 file changed, 3 insertions(+), 1 deletion(-)

diff --git a/src/main/msp/msp.c b/src/main/msp/msp.c
index 6ef4f48067..572a9a6a56 100644
--- a/src/main/msp/msp.c
+++ b/src/main/msp/msp.c
@@ -1286,6 +1286,7 @@ static bool mspProcessOutCommand(uint8_t cmdMSP, sbuf_t *dst)
         sbufWriteU16(dst, gpsRescueConfig()->ascendRate);
         sbufWriteU16(dst, gpsRescueConfig()->descendRate);
         sbufWriteU8(dst, gpsRescueConfig()->allowArmingWithoutFix);
+        sbufWriteU8(dst, gpsRescueConfig()->altitudeMode);
         break;
 
     case MSP_GPS_RESCUE_PIDS:
@@ -2181,11 +2182,12 @@ static mspResult_e mspProcessInCommand(mspDescriptor_t srcDesc, uint8_t cmdMSP,
         gpsRescueConfigMutable()->throttleHover = sbufReadU16(src);
         gpsRescueConfigMutable()->sanityChecks = sbufReadU8(src);
         gpsRescueConfigMutable()->minSats = sbufReadU8(src);
-        if (sbufBytesRemaining(src) >= 5) {
+        if (sbufBytesRemaining(src) >= 6) {
             // Added in API version 1.43
             gpsRescueConfigMutable()->ascendRate = sbufReadU16(src);
             gpsRescueConfigMutable()->descendRate = sbufReadU16(src);
             gpsRescueConfigMutable()->allowArmingWithoutFix = sbufReadU8(src);
+            gpsRescueConfigMutable()->altitudeMode = sbufReadU8(src);
         }
         break;