Skip to content

Commit

Permalink
Add missing covariance initialization (#74)
Browse files Browse the repository at this point in the history
Co-authored-by: Jonas Wahlen <jonas.wahlen@fixposition.com>
  • Loading branch information
jwahlen64 and Jonas Wahlen authored Nov 19, 2024
1 parent a66ef9a commit 55facad
Showing 1 changed file with 4 additions and 0 deletions.
Original file line number Diff line number Diff line change
Expand Up @@ -186,6 +186,8 @@ inline times::GpsTime ConvertGpsTime(const std::string& gps_wno, const std::stri
inline Eigen::Matrix<double, 3, 3> BuildCovMat3D(const double xx, const double yy, const double zz,
const double xy, const double yz, const double xz) {
Eigen::Matrix<double, 3, 3> cov;
cov.setZero();

// Diagonals
cov(0, 0) = xx; // 0
cov(1, 1) = yy; // 4
Expand Down Expand Up @@ -227,6 +229,8 @@ inline Eigen::Matrix<double, 6, 6> BuildCovMat6D(const double xx, const double y
const double yz, const double xz, double xx1, const double yy1,
const double zz1, const double xy1, const double yz1, double xz1) {
Eigen::Matrix<double, 6, 6> cov;
cov.setZero();

// Diagonals
cov(0, 0) = xx; // 0
cov(1, 1) = yy; // 7
Expand Down

0 comments on commit 55facad

Please sign in to comment.