From c9573b3c0c6e1d203ef3bcadd671820b20f16151 Mon Sep 17 00:00:00 2001 From: IvoFPV Date: Wed, 7 Aug 2019 21:01:26 +0200 Subject: [PATCH] Add iterm relax cutoff to msp --- src/main/msp/msp.c | 14 ++++++++++++++ 1 file changed, 14 insertions(+) diff --git a/src/main/msp/msp.c b/src/main/msp/msp.c index 0d3b9af2e6..081bc2e858 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);