diff --git a/src/main/common/maths.c b/src/main/common/maths.c index dd443ee80b..565684be82 100644 --- a/src/main/common/maths.c +++ b/src/main/common/maths.c @@ -118,28 +118,22 @@ float powerf(float base, int exp) { return result; } -int32_t applyDeadband(int32_t value, int32_t deadband) +int32_t applyDeadband(const int32_t value, const int32_t deadband) { if (ABS(value) < deadband) { - value = 0; - } else if (value > 0) { - value -= deadband; - } else if (value < 0) { - value += deadband; + return 0; } - return value; + + return value >= 0 ? value - deadband : value + deadband; } -float fapplyDeadband(float value, float deadband) +float fapplyDeadband(const float value, const float deadband) { if (fabsf(value) < deadband) { - value = 0; - } else if (value > 0) { - value -= deadband; - } else if (value < 0) { - value += deadband; + return 0; } - return value; + + return value >= 0 ? value - deadband : value + deadband; } void devClear(stdev_t *dev)