diff --git a/src/main/msp/msp.c b/src/main/msp/msp.c index 103fd804fb..7d94d3ec74 100644 --- a/src/main/msp/msp.c +++ b/src/main/msp/msp.c @@ -1522,6 +1522,12 @@ static bool mspProcessOutCommand(uint8_t cmdMSP, sbuf_t *dst) sbufWriteU8(dst, 0); sbufWriteU8(dst, 0); #endif +#if defined(USE_ITERM_RELAX) + // Added in MSP API 1.42 + sbufWriteU8(dst, currentPidProfile->iterm_relax_cutoff); +#else + sbufWriteU8(dst, 0); +#endif break; case MSP_SENSOR_CONFIG: @@ -2206,6 +2212,14 @@ static mspResult_e mspProcessInCommand(uint8_t cmdMSP, sbuf_t *src) #else sbufReadU8(src); sbufReadU8(src); +#endif + } + if(sbufBytesRemaining(src) >= 1) { + // Added in MSP API 1.42 +#if defined(USE_ITERM_RELAX) + currentPidProfile->iterm_relax_cutoff = sbufReadU8(src); +#else + sbufReadU8(src); #endif } pidInitConfig(currentPidProfile);