From 0aa05c9a93b9306073acda502ac96a876f3f1c9e Mon Sep 17 00:00:00 2001 From: Nicola De Pasquale Date: Fri, 11 Oct 2019 14:10:18 +0200 Subject: [PATCH] add gps_ublox_use_galileo and gps_set_home_point_once to MSP --- src/main/msp/msp.c | 8 ++++++++ 1 file changed, 8 insertions(+) diff --git a/src/main/msp/msp.c b/src/main/msp/msp.c index f627e45bda..c6140f78f6 100644 --- a/src/main/msp/msp.c +++ b/src/main/msp/msp.c @@ -1228,6 +1228,9 @@ static bool mspProcessOutCommand(uint8_t cmdMSP, sbuf_t *dst) sbufWriteU8(dst, gpsConfig()->sbasMode); sbufWriteU8(dst, gpsConfig()->autoConfig); sbufWriteU8(dst, gpsConfig()->autoBaud); + // Added in API version 1.43 + sbufWriteU8(dst, gpsConfig()->gps_set_home_point_once); + sbufWriteU8(dst, gpsConfig()->gps_ublox_use_galileo); break; case MSP_RAW_GPS: @@ -2144,6 +2147,11 @@ static mspResult_e mspProcessInCommand(uint8_t cmdMSP, sbuf_t *src) gpsConfigMutable()->sbasMode = sbufReadU8(src); gpsConfigMutable()->autoConfig = sbufReadU8(src); gpsConfigMutable()->autoBaud = sbufReadU8(src); + if (sbufBytesRemaining(src) >= 2) { + // Added in API version 1.43 + gpsConfigMutable()->gps_set_home_point_once = sbufReadU8(src); + gpsConfigMutable()->gps_ublox_use_galileo = sbufReadU8(src); + } break; #ifdef USE_GPS_RESCUE