diff --git a/src/main/config/config.c b/src/main/config/config.c index f1f5695754..938613caaf 100644 --- a/src/main/config/config.c +++ b/src/main/config/config.c @@ -569,28 +569,37 @@ void activateConfig(void) activateControlRateConfig(); - useRcControlsConfig(currentProfile->modeActivationConditions, &masterConfig.escAndServoConfig, ¤tProfile->pidProfile); + useRcControlsConfig( + currentProfile->modeActivationConditions, + &masterConfig.escAndServoConfig, + ¤tProfile->pidProfile + ); useGyroConfig(&masterConfig.gyroConfig); + #ifdef TELEMETRY useTelemetryConfig(&masterConfig.telemetryConfig); #endif + setPIDController(currentProfile->pidController); + #ifdef GPS gpsUseProfile(¤tProfile->gpsProfile); gpsUsePIDs(¤tProfile->pidProfile); #endif + useFailsafeConfig(¤tProfile->failsafeConfig); setAccelerationTrims(&masterConfig.accZero); + mixerUseConfigs( - currentProfile->servoConf, - &masterConfig.flight3DConfig, - &masterConfig.escAndServoConfig, - ¤tProfile->mixerConfig, - &masterConfig.airplaneConfig, - &masterConfig.rxConfig, - ¤tProfile->gimbalConfig - ); + currentProfile->servoConf, + &masterConfig.flight3DConfig, + &masterConfig.escAndServoConfig, + ¤tProfile->mixerConfig, + &masterConfig.airplaneConfig, + &masterConfig.rxConfig, + ¤tProfile->gimbalConfig + ); imuRuntimeConfig.gyro_cmpf_factor = masterConfig.gyro_cmpf_factor; imuRuntimeConfig.gyro_cmpfm_factor = masterConfig.gyro_cmpfm_factor; @@ -598,8 +607,18 @@ void activateConfig(void) imuRuntimeConfig.acc_unarmedcal = currentProfile->acc_unarmedcal;; imuRuntimeConfig.small_angle = masterConfig.small_angle; - configureImu(&imuRuntimeConfig, ¤tProfile->pidProfile, ¤tProfile->accDeadband); - configureAltitudeHold(¤tProfile->pidProfile, ¤tProfile->barometerConfig, ¤tProfile->rcControlsConfig, &masterConfig.escAndServoConfig); + configureImu( + &imuRuntimeConfig, + ¤tProfile->pidProfile, + ¤tProfile->accDeadband + ); + + configureAltitudeHold( + ¤tProfile->pidProfile, + ¤tProfile->barometerConfig, + ¤tProfile->rcControlsConfig, + &masterConfig.escAndServoConfig + ); calculateThrottleAngleScale(currentProfile->throttle_correction_angle); calculateAccZLowPassFilterRCTimeConstant(currentProfile->accz_lpf_cutoff);