1
0
Fork 0
mirror of https://github.com/betaflight/betaflight.git synced 2025-07-23 16:25:31 +03:00

MSP add GPS min rescue dth

This commit is contained in:
Hans Christian Olaussen 2021-04-10 23:28:22 +02:00
parent a5d0f7e457
commit e401a0b1ab

View file

@ -1451,6 +1451,8 @@ static bool mspProcessOutCommand(int16_t cmdMSP, sbuf_t *dst)
sbufWriteU16(dst, gpsRescueConfig()->descendRate); sbufWriteU16(dst, gpsRescueConfig()->descendRate);
sbufWriteU8(dst, gpsRescueConfig()->allowArmingWithoutFix); sbufWriteU8(dst, gpsRescueConfig()->allowArmingWithoutFix);
sbufWriteU8(dst, gpsRescueConfig()->altitudeMode); sbufWriteU8(dst, gpsRescueConfig()->altitudeMode);
// Added in API version 1.44
sbufWriteU16(dst, gpsRescueConfig()->minRescueDth);
break; break;
case MSP_GPS_RESCUE_PIDS: case MSP_GPS_RESCUE_PIDS:
@ -2451,6 +2453,10 @@ static mspResult_e mspProcessInCommand(mspDescriptor_t srcDesc, int16_t cmdMSP,
gpsRescueConfigMutable()->allowArmingWithoutFix = sbufReadU8(src); gpsRescueConfigMutable()->allowArmingWithoutFix = sbufReadU8(src);
gpsRescueConfigMutable()->altitudeMode = sbufReadU8(src); gpsRescueConfigMutable()->altitudeMode = sbufReadU8(src);
} }
if (sbufBytesRemaining(src) >= 2) {
// Added in API version 1.44
gpsRescueConfigMutable()->minRescueDth = sbufReadU16(src);
}
break; break;
case MSP_SET_GPS_RESCUE_PIDS: case MSP_SET_GPS_RESCUE_PIDS: