mirror of
https://github.com/PX4/PX4-Autopilot.git
synced 2026-06-01 02:55:07 +08:00
mc att multi: style fixes to be consistent with old controller
This commit is contained in:
@@ -130,9 +130,7 @@ void MulticopterAttitudeControlBase::control_attitude(float dt)
|
|||||||
e_R_cp(2, 1) = e_R_z_axis(0);
|
e_R_cp(2, 1) = e_R_z_axis(0);
|
||||||
|
|
||||||
/* rotation matrix for roll/pitch only rotation */
|
/* rotation matrix for roll/pitch only rotation */
|
||||||
R_rp = R
|
R_rp = R * (_I + e_R_cp * e_R_z_sin + e_R_cp * e_R_cp * (1.0f - e_R_z_cos));
|
||||||
* (_I + e_R_cp * e_R_z_sin
|
|
||||||
+ e_R_cp * e_R_cp * (1.0f - e_R_z_cos));
|
|
||||||
|
|
||||||
} else {
|
} else {
|
||||||
/* zero roll/pitch rotation */
|
/* zero roll/pitch rotation */
|
||||||
|
|||||||
Reference in New Issue
Block a user