fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-05-15 04:47:34 +08:00
Code Issues Packages Projects Releases Wiki Activity

rft: remove commented section

Browse Source
This commit is contained in:
Pedro-Roque
2025-02-05 16:36:37 +01:00
parent 2a7fef852c
commit 202f424aed
1 changed files with 0 additions and 37 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/lib/mixer_module/functions/FunctionThrusters.hpp
-37
View File
@@ -75,44 +75,7 @@ public:
static inline void updateValues(uint32_t reversible, float thrust_factor, float *values, int num_values)
{
// TODO(@Pedro-Roque): for now bypass this
/*if (thrust_factor > 0.f && thrust_factor <= 1.f) {
// thrust factor
// rel_thrust = factor * x^2 + (1-factor) * x,
const float a = thrust_factor;
const float b = (1.f - thrust_factor);
// don't recompute for all values (ax^2+bx+c=0)
const float tmp1 = b / (2.f * a);
const float tmp2 = b * b / (4.f * a * a);
for (int i = 0; i < num_values; ++i) {
float control = values[i];
if (control > 0.f) {
values[i] = -tmp1 + sqrtf(tmp2 + (control / a));
} else if (control < -0.f) {
values[i] = tmp1 - sqrtf(tmp2 - (control / a));
} else {
values[i] = 0.f;
}
}
}
for (int i = 0; i < num_values; ++i) {
if ((reversible & (1u << i)) == 0) {
if (values[i] < -FLT_EPSILON) {
values[i] = NAN;
} else {
// remap from [0, 1] to [-1, 1]
values[i] = values[i] * 2.f - 1.f;
}
}
}*/
}
bool reversible(OutputFunction func) const override { return false; }