mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-10-16 01:23:34 +08:00
Fixed signs
This commit is contained in:
@@ -78,7 +78,7 @@ void ECL_FWAttControlVector::control(float dt, float airspeed, float airspeed_sc
|
||||
}
|
||||
|
||||
math::Dcm R_bn(R_nb.transpose());
|
||||
math::Matrix R_yaw_bn = math::Dcm(math::EulerAngles(0.0f, 0.0f, -yaw));
|
||||
math::Matrix R_yaw_bn = math::Dcm(math::EulerAngles(0.0f, 0.0f, yaw)).transpose();
|
||||
|
||||
// Establish actuator signs and lift compensation
|
||||
float lift_sign = (R_bn(3, 3) >= 0) ? 1.0f : -1.0f;
|
||||
|
||||
Reference in New Issue
Block a user