1
0
Fork 0
mirror of https://github.com/betaflight/betaflight.git synced 2025-07-17 05:15:25 +03:00

improve code efficiency

This commit is contained in:
ctzsnooze 2019-09-22 14:06:31 +10:00
parent 891b47e11e
commit 5112b66a0f

View file

@ -106,7 +106,7 @@ FAST_CODE_NOINLINE float applyFfLimit(int axis, float value, float Kp, float cur
DEBUG_SET(DEBUG_FF_LIMIT, 1, value); DEBUG_SET(DEBUG_FF_LIMIT, 1, value);
} }
if (ffMaxRateLimit[axis] && (axis < FD_YAW)) { if (ffMaxRateLimit[axis]) {
if (fabsf(currentPidSetpoint) <= ffMaxRateLimit[axis]) { if (fabsf(currentPidSetpoint) <= ffMaxRateLimit[axis]) {
value = constrainf(value, (-ffMaxRateLimit[axis] - currentPidSetpoint) * Kp, (ffMaxRateLimit[axis] - currentPidSetpoint) * Kp); value = constrainf(value, (-ffMaxRateLimit[axis] - currentPidSetpoint) * Kp, (ffMaxRateLimit[axis] - currentPidSetpoint) * Kp);
} else { } else {
@ -121,7 +121,7 @@ FAST_CODE_NOINLINE float applyFfLimit(int axis, float value, float Kp, float cur
bool shouldApplyFfLimits(int axis) bool shouldApplyFfLimits(int axis)
{ {
return ffMaxRateLimit[axis] != 0.0f; return ffMaxRateLimit[axis] != 0.0f && axis < FD_YAW;
} }