Mirror/betaflight
1
0
Fork 0
mirror of https://github.com/betaflight/betaflight.git synced 2025-07-16 04:45:24 +03:00
Code Issues Wiki Activity

apply fast_code_pref correctly

Browse source
This commit is contained in:
ctzsnooze 2024-11-27 10:05:06 +11:00
parent f2071d6a53
commit 39cebcb13f
1 changed files with 8 additions and 8 deletions
Download patch file Download diff file Expand all files Collapse all files

16
src/main/flight/pid.c
View file

@ -317,7 +317,7 @@ void pidResetIterm(void)
}
#ifdef USE_WING
static float FAST_CODE_PREF calcWingThrottle(void)
static FAST_CODE_PREF float calcWingThrottle(void)
{
float batteryThrottleFactor = 1.0f;
if (pidRuntime.tpaSpeed.maxVoltage > 0.0f) {
@ -328,7 +328,7 @@ static float FAST_CODE_PREF calcWingThrottle(void)
return getMotorOutputRms() * batteryThrottleFactor;
}
static float FAST_CODE_PREF calcWingAcceleration(float throttle, float pitchAngleRadians)
static FAST_CODE_PREF float calcWingAcceleration(float throttle, float pitchAngleRadians)
{
const tpaSpeedParams_t *tpa = &pidRuntime.tpaSpeed;
@ -339,7 +339,7 @@ static float FAST_CODE_PREF calcWingAcceleration(float throttle, float pitchAngl
return thrust - drag + gravity;
}
static float FAST_CODE_PREF calcWingTpaArgument(void)
static FAST_CODE_PREF float calcWingTpaArgument(void)
{
const float t = calcWingThrottle();
const float pitchRadians = DECIDEGREES_TO_RADIANS(attitude.values.pitch);
@ -366,7 +366,7 @@ static float FAST_CODE_PREF calcWingTpaArgument(void)
return tpaArgument;
}
static void FAST_CODE_PREF updateStermTpaFactor(int axis, float tpaFactor)
static FAST_CODE_PREF void updateStermTpaFactor(int axis, float tpaFactor)
{
float tpaFactorSterm = tpaFactor;
if (pidRuntime.tpaCurveType == TPA_CURVE_HYPERBOLIC) {
@ -389,7 +389,7 @@ static void FAST_CODE_PREF updateStermTpaFactors(void) {
}
#endif // USE_WING
static float wingAdjustSetpoint(float currentPidSetpoint, int axis)
static FAST_CODE_PREF float wingAdjustSetpoint(float currentPidSetpoint, int axis)
{
#ifdef USE_WING
float adjustedSetpoint = currentPidSetpoint;
@ -1035,7 +1035,7 @@ static float getTpaFactor(const pidProfile_t *pidProfile, int axis, term_e term)
}
}
static float getSterm(int axis, const pidProfile_t *pidProfile, float setpoint)
static FAST_CODE_PREF float getSterm(int axis, const pidProfile_t *pidProfile, float setpoint)
{
#ifdef USE_WING
float sTerm = setpoint / getMaxRcRate(axis) * 1000.0f *
@ -1054,7 +1054,7 @@ static float getSterm(int axis, const pidProfile_t *pidProfile, float setpoint)
#endif
}
NOINLINE static void calculateSpaValues(const pidProfile_t *pidProfile)
NOINLINE static FAST_CODE_PREF void calculateSpaValues(const pidProfile_t *pidProfile)
{
#ifdef USE_WING
for (int axis = 0; axis < XYZ_AXIS_COUNT; axis++) {
@ -1068,7 +1068,7 @@ NOINLINE static void calculateSpaValues(const pidProfile_t *pidProfile)
#endif // USE_WING
}
NOINLINE static void applySpa(int axis, const pidProfile_t *pidProfile)
NOINLINE static FAST_CODE_PREF void applySpa(int axis, const pidProfile_t *pidProfile)
{
#ifdef USE_WING
spaMode_e mode = pidProfile->spa_mode[axis];