Skip to content

Commit 5efbbe3

Browse files
author
M. Fatih Cırıt
committed
fix naming
Signed-off-by: M. Fatih Cırıt <mfc@leodrive.ai>
1 parent 662dbff commit 5efbbe3

File tree

2 files changed

+5
-5
lines changed

2 files changed

+5
-5
lines changed

localization/ndt_scan_matcher/include/ndt_scan_matcher/ndt_scan_matcher_core.hpp

+1-1
Original file line numberDiff line numberDiff line change
@@ -205,7 +205,7 @@ class NDTScanMatcher : public rclcpp::Node
205205
bool close_ndt_pose_source_ = false;
206206
struct trusted_pose_
207207
{
208-
double pose_avarage_rmse_xy = 0.0;
208+
double pose_average_rmse_xy = 0.0;
209209
double yaw_rmse = 0.0;
210210
} trustedPose;
211211

localization/ndt_scan_matcher/src/ndt_scan_matcher_core.cpp

+4-4
Original file line numberDiff line numberDiff line change
@@ -331,7 +331,7 @@ void NDTScanMatcher::callback_trusted_source_pose(
331331
geometry_msgs::msg::PoseWithCovarianceStamped::ConstSharedPtr pose_conv_msg_ptr)
332332
{
333333
trusted_source_pose_ = *pose_conv_msg_ptr;
334-
trustedPose.pose_avarage_rmse_xy = (std::sqrt(trusted_source_pose_.pose.covariance[0]) +
334+
trustedPose.pose_average_rmse_xy = (std::sqrt(trusted_source_pose_.pose.covariance[0]) +
335335
std::sqrt(trusted_source_pose_.pose.covariance[7])) /
336336
2;
337337
trustedPose.yaw_rmse = std::sqrt(trusted_source_pose_.pose.covariance[35]);
@@ -595,13 +595,13 @@ std::array<double, 36> NDTScanMatcher::covariance_modifier(
595595
}
596596

597597
if (
598-
trustedPose.pose_avarage_rmse_xy <= 0.10 &&
598+
trustedPose.pose_average_rmse_xy <= 0.10 &&
599599
trustedPose.yaw_rmse < std::sqrt(in_ndt_covariance[35])) {
600600
close_ndt_pose_source_ = true;
601-
} else if (trustedPose.pose_avarage_rmse_xy <= 0.10) {
601+
} else if (trustedPose.pose_average_rmse_xy <= 0.10) {
602602
ndt_covariance[0] = 1000000;
603603
ndt_covariance[7] = 1000000;
604-
} else if (trustedPose.pose_avarage_rmse_xy <= 0.25) {
604+
} else if (trustedPose.pose_average_rmse_xy <= 0.25) {
605605
/*
606606
* ndt_rmse = ndt_max_rmse_meters - (gnss_rmse * (ndt_max_rmse_meters - ndt_min_rmse_meters) /
607607
* normalization_coeff) ndt_min_rmse_meters = in_ndt_rmse ndt_max_rmse_meters = in_ndt_rmse * 2

0 commit comments

Comments
 (0)