diff --git a/src/main/common/global_functions.c b/src/main/common/global_functions.c index 7421dab33c..b4033479e9 100644 --- a/src/main/common/global_functions.c +++ b/src/main/common/global_functions.c @@ -142,7 +142,7 @@ float NOINLINE getThrottleScale(float globalThrottleScale) { } } -int16_t FAST_CODE getRcCommandOverride(int16_t command[], uint8_t axis) { +int16_t getRcCommandOverride(int16_t command[], uint8_t axis) { int16_t outputValue = command[axis]; if (GLOBAL_FUNCTION_FLAG(GLOBAL_FUNCTION_FLAG_OVERRIDE_SWAP_ROLL_YAW) && axis == FD_ROLL) { diff --git a/src/main/fc/fc_init.c b/src/main/fc/fc_init.c index 990c02aa3d..2cee3e2d00 100644 --- a/src/main/fc/fc_init.c +++ b/src/main/fc/fc_init.c @@ -655,10 +655,10 @@ void init(void) #ifdef USE_RPM_FILTER disableRpmFilters(); - if (STATE(ESC_SENSOR_ENABLED) && (rpmFilterConfig()->gyro_filter_enabled || rpmFilterConfig()->dterm_filter_enabled)) { + // if (STATE(ESC_SENSOR_ENABLED) && (rpmFilterConfig()->gyro_filter_enabled || rpmFilterConfig()->dterm_filter_enabled)) { rpmFiltersInit(); setTaskEnabled(TASK_RPM_FILTER, true); - } + // } #endif systemState |= SYSTEM_STATE_READY; diff --git a/src/main/flight/mixer.c b/src/main/flight/mixer.c index 09f7b32e8f..30d4f1f876 100755 --- a/src/main/flight/mixer.c +++ b/src/main/flight/mixer.c @@ -290,7 +290,7 @@ void mixerResetDisarmedMotors(void) } } -static FAST_CODE NOINLINE uint16_t handleOutputScaling( +static uint16_t handleOutputScaling( int16_t input, // Input value from the mixer int16_t stopThreshold, // Threshold value to check if motor should be rotating or not int16_t onStopValue, // Value sent to the ESC when min rotation is required - on motor_stop it is STOP command, without motor_stop it's a value that keeps rotation @@ -318,7 +318,7 @@ static FAST_CODE NOINLINE uint16_t handleOutputScaling( return value; } -void FAST_CODE NOINLINE writeMotors(void) +void FAST_CODE writeMotors(void) { for (int i = 0; i < motorCount; i++) { uint16_t motorValue; @@ -438,7 +438,7 @@ static int getReversibleMotorsThrottleDeadband(void) return feature(FEATURE_MOTOR_STOP) ? reversibleMotorsConfig()->neutral : directionValue; } -void FAST_CODE NOINLINE mixTable(const float dT) +void FAST_CODE mixTable(const float dT) { int16_t input[3]; // RPY, range [-500:+500] // Allow direct stick input to motors in passthrough mode on airplanes diff --git a/src/main/flight/rpm_filter.c b/src/main/flight/rpm_filter.c index 7d861de498..e2b2c9849d 100644 --- a/src/main/flight/rpm_filter.c +++ b/src/main/flight/rpm_filter.c @@ -22,6 +22,8 @@ * along with this program. If not, see http://www.gnu.org/licenses/. */ +#include "platform.h" + #include "flight/rpm_filter.h" #include "config/parameter_group.h" @@ -82,7 +84,7 @@ void nullRpmFilterUpdate(rpmFilterBank_t *filterBank, uint8_t motor, float baseF UNUSED(baseFrequency); } -float FAST_CODE rpmFilterApply(rpmFilterBank_t *filterBank, uint8_t axis, float input) +float rpmFilterApply(rpmFilterBank_t *filterBank, uint8_t axis, float input) { float output = input; @@ -136,7 +138,7 @@ void disableRpmFilters(void) { rpmGyroApplyFn = (rpmFilterApplyFnPtr)nullRpmFilterApply; } -void FAST_CODE NOINLINE rpmFilterUpdate(rpmFilterBank_t *filterBank, uint8_t motor, float baseFrequency) +void rpmFilterUpdate(rpmFilterBank_t *filterBank, uint8_t motor, float baseFrequency) { for (int axis = 0; axis < XYZ_AXIS_COUNT; axis++) { @@ -177,7 +179,7 @@ void rpmFiltersInit(void) } } -void FAST_CODE NOINLINE rpmFilterUpdateTask(timeUs_t currentTimeUs) +void rpmFilterUpdateTask(timeUs_t currentTimeUs) { UNUSED(currentTimeUs); @@ -198,7 +200,7 @@ void FAST_CODE NOINLINE rpmFilterUpdateTask(timeUs_t currentTimeUs) } } -float FAST_CODE rpmFilterGyroApply(uint8_t axis, float input) +float rpmFilterGyroApply(uint8_t axis, float input) { return rpmGyroApplyFn(&gyroRpmFilters, axis, input); } diff --git a/src/main/navigation/navigation.c b/src/main/navigation/navigation.c index cc9a3e7593..413c3f49a7 100755 --- a/src/main/navigation/navigation.c +++ b/src/main/navigation/navigation.c @@ -3433,7 +3433,7 @@ bool navigationRTHAllowsLanding(void) (allow == NAV_RTH_ALLOW_LANDING_FS_ONLY && FLIGHT_MODE(FAILSAFE_MODE)); } -bool FAST_CODE isNavLaunchEnabled(void) +bool isNavLaunchEnabled(void) { return IS_RC_MODE_ACTIVE(BOXNAVLAUNCH) || feature(FEATURE_FW_LAUNCH); } diff --git a/src/main/scheduler/scheduler.c b/src/main/scheduler/scheduler.c index ee83dd5fa0..e9c00345ea 100755 --- a/src/main/scheduler/scheduler.c +++ b/src/main/scheduler/scheduler.c @@ -178,7 +178,7 @@ void setTaskEnabled(cfTaskId_e taskId, bool enabled) } } -timeDelta_t FAST_CODE NOINLINE getTaskDeltaTime(cfTaskId_e taskId) +timeDelta_t getTaskDeltaTime(cfTaskId_e taskId) { if (taskId == TASK_SELF) { return currentTask->taskLatestDeltaTime;