From 0c5ea0f5c63455ce1bf91f4f8fcf70813768d796 Mon Sep 17 00:00:00 2001 From: borisbstyle Date: Sun, 19 Jun 2016 21:21:31 +0200 Subject: [PATCH] Fix Configurator Save Error --- src/main/io/serial_msp.c | 42 ++++++++++++++++++++-------------------- 1 file changed, 21 insertions(+), 21 deletions(-) diff --git a/src/main/io/serial_msp.c b/src/main/io/serial_msp.c index 285de3c3a..b1eb17c89 100644 --- a/src/main/io/serial_msp.c +++ b/src/main/io/serial_msp.c @@ -1666,27 +1666,6 @@ static bool processInCommand(void) case MSP_SET_BF_CONFIG: - case MSP_SET_PID_ADVANCED_CONFIG : - masterConfig.gyro_sync_denom = read8(); - masterConfig.pid_process_denom = read8(); - masterConfig.use_unsyncedPwm = read8(); - masterConfig.fast_pwm_protocol = read8(); - masterConfig.motor_pwm_rate = read16(); - break; - case MSP_SET_FILTER_CONFIG : - masterConfig.gyro_soft_lpf_hz = read8(); - currentProfile->pidProfile.dterm_lpf_hz = read16(); - currentProfile->pidProfile.yaw_lpf_hz = read16(); - break; - case MSP_SET_ADVANCED_TUNING: - currentProfile->pidProfile.rollPitchItermIgnoreRate = read16(); - currentProfile->pidProfile.yawItermIgnoreRate = read16(); - currentProfile->pidProfile.yaw_p_limit = read16(); - break; - case MSP_SET_TEMPORARY_COMMANDS: - currentControlRateProfile->rcYawRate8 = read8(); - break; - #ifdef USE_QUAD_MIXER_ONLY read8(); // mixerMode ignored #else @@ -1801,6 +1780,27 @@ static bool processInCommand(void) // proceed as usual with MSP commands break; #endif + + case MSP_SET_PID_ADVANCED_CONFIG : + masterConfig.gyro_sync_denom = read8(); + masterConfig.pid_process_denom = read8(); + masterConfig.use_unsyncedPwm = read8(); + masterConfig.fast_pwm_protocol = read8(); + masterConfig.motor_pwm_rate = read16(); + break; + case MSP_SET_FILTER_CONFIG : + masterConfig.gyro_soft_lpf_hz = read8(); + currentProfile->pidProfile.dterm_lpf_hz = read16(); + currentProfile->pidProfile.yaw_lpf_hz = read16(); + break; + case MSP_SET_ADVANCED_TUNING: + currentProfile->pidProfile.rollPitchItermIgnoreRate = read16(); + currentProfile->pidProfile.yawItermIgnoreRate = read16(); + currentProfile->pidProfile.yaw_p_limit = read16(); + break; + case MSP_SET_TEMPORARY_COMMANDS: + currentControlRateProfile->rcYawRate8 = read8(); + break; default: // we do not know how to handle the (valid) message, indicate error MSP $M! return false;