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

Fix limiting in mc mixer

Browse Source
This commit is contained in:
Anton Babushkin
2015-03-21 16:12:33 +01:00
parent 49834b11cb
commit 95be7c2289
1 changed files with 11 additions and 2 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/modules/systemlib/mixer/mixer_multirotor.cpp
+11 -2
View File
@@ -244,14 +244,23 @@ MultirotorMixer::mix(float *outputs, unsigned space)
if (min_out < 0.0f) { if (min_out < 0.0f) {
float scale_in = thrust / (thrust - min_out); float scale_in = thrust / (thrust - min_out);
max_out = 0.0f;
/* mix again with adjusted controls */ /* mix again with adjusted controls */
for (unsigned i = 0; i < _rotor_count; i++) { for (unsigned i = 0; i < _rotor_count; i++) {
outputs[i] = scale_in * (roll * _rotors[i].roll_scale + pitch * _rotors[i].pitch_scale) + thrust; float out = scale_in * (roll * _rotors[i].roll_scale + pitch * _rotors[i].pitch_scale) + thrust;
/* update max output value */
if (out > max_out) {
max_out = out;
}
outputs[i] = out;
} }
_limits.roll_pitch = true; _limits.roll_pitch = true;
} else { } else {
/* roll/pitch mixed without limiting, add yaw control */ /* roll/pitch mixed without lower side limiting, add yaw control */
for (unsigned i = 0; i < _rotor_count; i++) { for (unsigned i = 0; i < _rotor_count; i++) {
outputs[i] += yaw * _rotors[i].yaw_scale; outputs[i] += yaw * _rotors[i].yaw_scale;
} }