diff --git a/src/main/msp/msp.c b/src/main/msp/msp.c index f627e45bd..c6140f78f 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