mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-10-16 15:03:33 +08:00
mc_att_control_main: do not apply the yaw weight for the feedforward term
The meaning of the yaw weight changed with #8003: - before, the yaw weight decreased with increasing tilt angle error, so it was mostly 1 - now, it is constant and depends on the tuning gains (around 0.4 by default) It means that #8003 reduced the feedforward term, and we get the closer behavior as before with this change. It also reduces coupling between different parameters.
This commit is contained in:
@@ -424,7 +424,6 @@ MulticopterAttitudeControl::control_attitude(float dt)
|
||||
* because it's the rotation axis for body yaw and multiply it by the rate and gain. */
|
||||
Vector3f yaw_feedforward_rate = q.inversed().dcm_z();
|
||||
yaw_feedforward_rate *= _v_att_sp.yaw_sp_move_rate * _yaw_ff.get();
|
||||
yaw_feedforward_rate(2) *= yaw_w;
|
||||
_rates_sp += yaw_feedforward_rate;
|
||||
|
||||
|
||||
|
||||
Reference in New Issue
Block a user