dark0707
/
px4-firmware
forked from Archive/PX4-Autopilot
1
0
Fork 0
Code Pull Requests Activity

mixer_module: correct output_limit_calc_single calculation

This commit is contained in:
Matthias Grob 2023-12-04 20:00:31 +01:00 committed by Daniel Agar
parent fb3123e33b
commit 0a78690356
1 changed files with 3 additions and 3 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

6
src/lib/mixer_module/mixer_module.cpp
View File

@ -528,10 +528,10 @@ uint16_t MixingOutput::output_limit_calc_single(int i, float value) const
value = -1.f * value;
}
uint16_t effective_output = value * (_max_value[i] - _min_value[i]) / 2 + (_max_value[i] + _min_value[i]) / 2;
const float output = math::interpolate(value, -1.f, 1.f,
static_cast<float>(_min_value[i]), static_cast<float>(_max_value[i]));
// last line of defense against invalid inputs
return math::constrain(effective_output, _min_value[i], _max_value[i]);
return math::constrain(lroundf(output), 0L, static_cast<long>(UINT16_MAX));
}
void