mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-10-15 23:33:34 +08:00
Attitude estimator EKF: fix warnings
This commit is contained in:
@@ -462,11 +462,11 @@ const unsigned int loop_interval_alarm = 6500; // loop interval in microseconds
|
||||
if (vision.timestamp_boot > 0 && (hrt_elapsed_time(&vision.timestamp_boot) < 500000)) {
|
||||
|
||||
math::Quaternion q(vision.q);
|
||||
math::Matrix<3, 3> R = q.to_dcm();
|
||||
math::Matrix<3, 3> Rvis = q.to_dcm();
|
||||
|
||||
math::Vector<3> v(1.0f, 0.0f, 0.4f);
|
||||
|
||||
math::Vector<3> vn = R * v;
|
||||
math::Vector<3> vn = Rvis * v;
|
||||
|
||||
z_k[6] = vn(0);
|
||||
z_k[7] = vn(1);
|
||||
|
||||
@@ -45,4 +45,4 @@ MODULE_STACKSIZE = 1200
|
||||
|
||||
EXTRACFLAGS = -Wno-float-equal -Wframe-larger-than=3600
|
||||
|
||||
EXTRACXXFLAGS = -Wframe-larger-than=2200
|
||||
EXTRACXXFLAGS = -Wframe-larger-than=2400
|
||||
|
||||
Reference in New Issue
Block a user