From e401a0b1ab44674fc232f1f76d5cfef9232808a2 Mon Sep 17 00:00:00 2001 From: Hans Christian Olaussen <41271048+klutvott123@users.noreply.github.com> Date: Sat, 10 Apr 2021 23:28:22 +0200 Subject: [PATCH] MSP add GPS min rescue dth --- src/main/msp/msp.c | 6 ++++++ 1 file changed, 6 insertions(+) diff --git a/src/main/msp/msp.c b/src/main/msp/msp.c index ad9adef0fe..4b821caba9 100644 --- a/src/main/msp/msp.c +++ b/src/main/msp/msp.c @@ -1451,6 +1451,8 @@ static bool mspProcessOutCommand(int16_t cmdMSP, sbuf_t *dst) sbufWriteU16(dst, gpsRescueConfig()->descendRate); sbufWriteU8(dst, gpsRescueConfig()->allowArmingWithoutFix); sbufWriteU8(dst, gpsRescueConfig()->altitudeMode); + // Added in API version 1.44 + sbufWriteU16(dst, gpsRescueConfig()->minRescueDth); break; case MSP_GPS_RESCUE_PIDS: @@ -2451,6 +2453,10 @@ static mspResult_e mspProcessInCommand(mspDescriptor_t srcDesc, int16_t cmdMSP, gpsRescueConfigMutable()->allowArmingWithoutFix = sbufReadU8(src); gpsRescueConfigMutable()->altitudeMode = sbufReadU8(src); } + if (sbufBytesRemaining(src) >= 2) { + // Added in API version 1.44 + gpsRescueConfigMutable()->minRescueDth = sbufReadU16(src); + } break; case MSP_SET_GPS_RESCUE_PIDS: