Mirrors_Framework/PX4-Autopilot
1
0
Fork 0
mirror of https://github.com/PX4/PX4-Autopilot.git synced 2026-05-10 14:51:15 +08:00
Code Issues Actions 8 Packages Projects Releases Wiki Activity

fix(fw_attitude_control): correct turn coordination

Browse Source
This commit is contained in:
ttechnick
2026-04-01 18:56:38 +02:00
committed by Nick
parent d2e3668ad9
commit 935a21d05c
1 changed files with 0 additions and 3 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/modules/fw_att_control/FixedwingAttitudeControl.cpp
-3
View File
@@ -310,9 +310,6 @@ void FixedwingAttitudeControl::Run()
const float yawrate_ff = CONSTANTS_ONE_G * q1 / V;
const float pitchrate_ff = q1 * yawrate_ff / (1.f - 2.f * q_current(1) * q_current(1) - 2.f * q_current(2) * q_current(2));
body_rates_setpoint(1) += pitchrate_ff;
body_rates_setpoint(2) += yawrate_ff;
// Limit turn coordination to normal flight envelope
const float cos_tilt = 1.f - 2.f * (q_current(1) * q_current(1) + q_current(2) * q_current(2));
const float tilt = acosf(math::constrain((cos_tilt), -1.f, 1.f));