We read every piece of feedback, and take your input very seriously.
To see all available qualifiers, see our documentation.
1 parent 799e4f9 commit c0e9251Copy full SHA for c0e9251
perception/autoware_compare_map_segmentation/src/distance_based_compare_map_filter/node.cpp
@@ -59,14 +59,14 @@ bool DistanceBasedStaticMapLoader::is_close_to_map(
59
}
60
61
std::vector<int> nn_indices(1);
62
- std::vector<float> nn_distances(1);
+ std::vector<float> nn_sqr_distances(1);
63
if (!isFinite(point)) {
64
return false;
65
66
- if (!tree_->nearestKSearch(point, 1, nn_indices, nn_distances)) {
+ if (!tree_->nearestKSearch(point, 1, nn_indices, nn_sqr_distances)) {
67
68
69
- if (nn_distances[0] > distance_threshold) {
+ if (nn_sqr_distances[0] > distance_threshold * distance_threshold) {
70
71
72
return true;
0 commit comments