Skip to content

Commit

Permalink
fix naming
Browse files Browse the repository at this point in the history
Signed-off-by: M. Fatih Cırıt <[email protected]>
  • Loading branch information
M. Fatih Cırıt authored and meliketanrikulu committed Mar 5, 2024
1 parent 43c4f29 commit 9f0e647
Show file tree
Hide file tree
Showing 2 changed files with 5 additions and 5 deletions.
Original file line number Diff line number Diff line change
Expand Up @@ -205,7 +205,7 @@ class NDTScanMatcher : public rclcpp::Node
bool close_ndt_pose_source_ = false;
struct trusted_pose_
{
double pose_avarage_rmse_xy = 0.0;
double pose_average_rmse_xy = 0.0;
double yaw_rmse = 0.0;
} trustedPose;

Expand Down
8 changes: 4 additions & 4 deletions localization/ndt_scan_matcher/src/ndt_scan_matcher_core.cpp
Original file line number Diff line number Diff line change
Expand Up @@ -331,7 +331,7 @@ void NDTScanMatcher::callback_trusted_source_pose(
geometry_msgs::msg::PoseWithCovarianceStamped::ConstSharedPtr pose_conv_msg_ptr)
{
trusted_source_pose_ = *pose_conv_msg_ptr;
trustedPose.pose_avarage_rmse_xy = (std::sqrt(trusted_source_pose_.pose.covariance[0]) +
trustedPose.pose_average_rmse_xy = (std::sqrt(trusted_source_pose_.pose.covariance[0]) +
std::sqrt(trusted_source_pose_.pose.covariance[7])) /
2;
trustedPose.yaw_rmse = std::sqrt(trusted_source_pose_.pose.covariance[35]);
Expand Down Expand Up @@ -595,13 +595,13 @@ std::array<double, 36> NDTScanMatcher::covariance_modifier(
}

if (
trustedPose.pose_avarage_rmse_xy <= 0.10 &&
trustedPose.pose_average_rmse_xy <= 0.10 &&
trustedPose.yaw_rmse < std::sqrt(in_ndt_covariance[35])) {
close_ndt_pose_source_ = true;
} else if (trustedPose.pose_avarage_rmse_xy <= 0.10) {
} else if (trustedPose.pose_average_rmse_xy <= 0.10) {
ndt_covariance[0] = 1000000;
ndt_covariance[7] = 1000000;
} else if (trustedPose.pose_avarage_rmse_xy <= 0.25) {
} else if (trustedPose.pose_average_rmse_xy <= 0.25) {
/*
* ndt_rmse = ndt_max_rmse_meters - (gnss_rmse * (ndt_max_rmse_meters - ndt_min_rmse_meters) /
* normalization_coeff) ndt_min_rmse_meters = in_ndt_rmse ndt_max_rmse_meters = in_ndt_rmse * 2
Expand Down

0 comments on commit 9f0e647

Please sign in to comment.