Mirror/betaflight
1
0
Fork 0
mirror of https://github.com/betaflight/betaflight.git synced 2025-07-20 14:55:21 +03:00
Code Issues Wiki Activity

add altitude mode setting to msp

Browse source
This commit is contained in:
Nicola De Pasquale 2019-10-23 22:54:33 +02:00
parent 040724bacd
commit 98d6105592
1 changed files with 3 additions and 1 deletions
Download patch file Download diff file Expand all files Collapse all files

4
src/main/msp/msp.c
View file

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