fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-04-14 10:07:39 +08:00
Code Issues Packages Projects Releases Wiki Activity

mavlink: odometry: Initialize the covariance matrix to 0 to prevent the entire matrix from becoming invalid after mavros performs coordinate transformation. (#26321)

Browse Source
This commit is contained in:
David Meng 2026-01-25 05:52:13 +08:00 committed by GitHub
parent e2864e521f
commit 1cfab8feb2
No known key found for this signature in database
GPG Key ID: B5690EEEBB952194
1 changed files with 2 additions and 2 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

4
src/modules/mavlink/streams/ODOMETRY.hpp
View File

@ -112,7 +112,7 @@ private:
// Row-major representation of a 6x6 pose cross-covariance matrix upper right triangle
// (states: x, y, z, roll, pitch, yaw; first six entries are the first ROW, next five entries are the second ROW, etc.)
for (auto &pc : msg.pose_covariance) {
pc = NAN;
pc = 0.f;
}
msg.pose_covariance[0] = odom.position_variance[0]; // X row 0, col 0
@ -127,7 +127,7 @@ private:
// Row-major representation of a 6x6 velocity cross-covariance matrix upper right triangle
// (states: vx, vy, vz, rollspeed, pitchspeed, yawspeed; first six entries are the first ROW, next five entries are the second ROW, etc.)
for (auto &vc : msg.velocity_covariance) {
vc = NAN;
vc = 0.f;
}
msg.velocity_covariance[0] = odom.velocity_variance[0]; // X row 0, col 0