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

Limited Z-compensation much stronger to prevent throttle jumps

Browse Source
This commit is contained in:
Lorenz Meier
2012-09-09 22:18:21 +02:00
parent 6caa3038ba
commit 80c6252c0a
1 changed files with 4 additions and 4 deletions
Download Patch File Download Diff File Expand all files Collapse all files
apps/multirotor_att_control/multirotor_attitude_control.c
+4 -4
View File
@@ -252,15 +252,15 @@ void multirotor_control_attitude(const struct vehicle_attitude_setpoint_s *att_s
*/ */
float zcompensation = 1.0f; float zcompensation = 1.0f;
if (fabsf(att->roll) > 1.0f) { if (fabsf(att->roll) > 0.3f) {
zcompensation *= 1.85081571768f; zcompensation *= 1.04675160154f;
} else { } else {
zcompensation *= 1.0f / cosf(att->roll); zcompensation *= 1.0f / cosf(att->roll);
} }
if (fabsf(att->pitch) > 1.0f) { if (fabsf(att->pitch) > 0.3f) {
zcompensation *= 1.85081571768f; zcompensation *= 1.04675160154f;
} else { } else {
zcompensation *= 1.0f / cosf(att->pitch); zcompensation *= 1.0f / cosf(att->pitch);