mc att multi: style fixes to be consistent with old controller

This commit is contained in:
Thomas Gubler
2015-02-22 14:17:32 +01:00
parent 4d26c2164e
commit 4bc2d5f687
@@ -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 */