Mirrors_Framework/PX4-Autopilot
1
0
Fork 0
mirror of https://github.com/PX4/PX4-Autopilot.git synced 2026-06-02 11:59:17 +08:00
Code Issues Actions 16 Packages Projects Releases Wiki Activity

mc_att_control: clarify comment about yaw feed forward

Browse Source
This commit is contained in:
Matthias Grob
2018-03-15 17:45:32 +01:00
committed by Beat Küng
parent ff25c7f48a
commit ed0b6db2de
1 changed files with 3 additions and 4 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/modules/mc_att_control/mc_att_control_main.cpp
+3 -4
View File
@@ -878,10 +878,9 @@ MulticopterAttitudeControl::control_attitude(float dt)
eq = eq.emult(attitude_gain); eq = eq.emult(attitude_gain);
_rates_sp = math::Vector<3>(eq.data()); _rates_sp = math::Vector<3>(eq.data());
/* Feed forward the yaw setpoint rate. We need to transform the yaw from world into body frame. /* Feed forward the yaw setpoint rate. We need to apply the yaw rate in the body frame.
* The following is a simplification of: * We infer the body z axis by taking the last column of R.transposed (== q.inversed)
* R.transposed() * Vector3f(0.f, 0.f, _v_att_sp.yaw_sp_move_rate * _params.yaw_ff) * 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(); Vector3f yaw_feedforward_rate = q.inversed().dcm_z();
yaw_feedforward_rate *= _v_att_sp.yaw_sp_move_rate * _params.yaw_ff; yaw_feedforward_rate *= _v_att_sp.yaw_sp_move_rate * _params.yaw_ff;