From 9c6603fae99d6e89de12b9ba38c4298c7b1c2f59 Mon Sep 17 00:00:00 2001 From: Miguel Angel Mulero Martinez Date: Tue, 5 Jun 2018 08:19:24 +0200 Subject: [PATCH] Add new range for gyro lpf 1 into MSP --- src/main/interface/msp.c | 4 +++- 1 file changed, 3 insertions(+), 1 deletion(-) diff --git a/src/main/interface/msp.c b/src/main/interface/msp.c index be827b00d4..3b9d9c38e3 100644 --- a/src/main/interface/msp.c +++ b/src/main/interface/msp.c @@ -1251,6 +1251,7 @@ static bool mspProcessOutCommand(uint8_t cmdMSP, sbuf_t *dst) sbufWriteU8(dst, currentPidProfile->dterm_filter_type); sbufWriteU8(dst, gyroConfig()->gyro_hardware_lpf); sbufWriteU8(dst, gyroConfig()->gyro_32khz_hardware_lpf); + sbufWriteU16(dst, gyroConfig()->gyro_lowpass_hz); sbufWriteU16(dst, gyroConfig()->gyro_lowpass2_hz); sbufWriteU8(dst, gyroConfig()->gyro_lowpass_type); sbufWriteU8(dst, gyroConfig()->gyro_lowpass2_type); @@ -1715,9 +1716,10 @@ static mspResult_e mspProcessInCommand(uint8_t cmdMSP, sbuf_t *src) if (sbufBytesRemaining(src) >= 1) { currentPidProfile->dterm_filter_type = sbufReadU8(src); } - if (sbufBytesRemaining(src) >= 8) { + if (sbufBytesRemaining(src) >= 10) { gyroConfigMutable()->gyro_hardware_lpf = sbufReadU8(src); gyroConfigMutable()->gyro_32khz_hardware_lpf = sbufReadU8(src); + gyroConfigMutable()->gyro_lowpass_hz = sbufReadU16(src); gyroConfigMutable()->gyro_lowpass2_hz = sbufReadU16(src); gyroConfigMutable()->gyro_lowpass_type = sbufReadU8(src); gyroConfigMutable()->gyro_lowpass2_type = sbufReadU8(src);