Skip to content

Commit

Permalink
fix to match the change in TreeStructuredParzenEstimator
Browse files Browse the repository at this point in the history
Signed-off-by: a-maumau <[email protected]>
  • Loading branch information
a-maumau committed Jun 7, 2024
1 parent 71933cc commit 6c93592
Showing 1 changed file with 2 additions and 2 deletions.
4 changes: 2 additions & 2 deletions localization/ndt_scan_matcher/src/ndt_scan_matcher_core.cpp
Original file line number Diff line number Diff line change
Expand Up @@ -1026,14 +1026,14 @@ geometry_msgs::msg::PoseWithCovarianceStamped NDTScanMatcher::align_pose(
const double stddev_pitch = std::sqrt(covariance(4, 4));

// Since only yaw is uniformly sampled, we define the mean and standard deviation for the others.
const std::vector<double> sample_mean{
std::vector<double> sample_mean{
initial_pose_with_cov.pose.pose.position.x, // trans_x
initial_pose_with_cov.pose.pose.position.y, // trans_y
initial_pose_with_cov.pose.pose.position.z, // trans_z
base_rpy.x, // angle_x
base_rpy.y // angle_y
};
const std::vector<double> sample_stddev{stddev_x, stddev_y, stddev_z, stddev_roll, stddev_pitch};
std::vector<double> sample_stddev{stddev_x, stddev_y, stddev_z, stddev_roll, stddev_pitch};

// Optimizing (x, y, z, roll, pitch, yaw) 6 dimensions.
TreeStructuredParzenEstimator tpe(
Expand Down

0 comments on commit 6c93592

Please sign in to comment.