From 00868512c8f14c39f232010eaf6fae5d8ea172a3 Mon Sep 17 00:00:00 2001 From: kminoda Date: Tue, 4 Jun 2024 16:27:06 +0900 Subject: [PATCH] test modification Signed-off-by: kminoda --- localization/ekf_localizer/src/covariance.cpp | 2 ++ 1 file changed, 2 insertions(+) diff --git a/localization/ekf_localizer/src/covariance.cpp b/localization/ekf_localizer/src/covariance.cpp index 0c98ac6857ea5..46c73756fab47 100644 --- a/localization/ekf_localizer/src/covariance.cpp +++ b/localization/ekf_localizer/src/covariance.cpp @@ -24,6 +24,8 @@ std::array ekfCovarianceToPoseMessageCovariance(const Matrix6d & P) std::array covariance; covariance.fill(0.); + float points_distance = 0.0f; + covariance[COV_IDX::X_X] = P(IDX::X, IDX::X); covariance[COV_IDX::X_Y] = P(IDX::X, IDX::Y); covariance[COV_IDX::X_YAW] = P(IDX::X, IDX::YAW);