Skip to content

Commit ed9de41

Browse files
committed
fix: change height downsize logic
Signed-off-by: yoshiri <yoshiyoshidetteiu@gmail.com>
1 parent b2cd2aa commit ed9de41

File tree

1 file changed

+3
-2
lines changed

1 file changed

+3
-2
lines changed

perception/compare_map_segmentation/src/voxel_grid_map_loader.cpp

+3-2
Original file line numberDiff line numberDiff line change
@@ -241,8 +241,9 @@ bool VoxelGridMapLoader::is_in_voxel(
241241
const double dist_x = map->points.at(voxel_index).x - target_point.x;
242242
const double dist_y = map->points.at(voxel_index).y - target_point.y;
243243
const double dist_z = map->points.at(voxel_index).z - target_point.z;
244-
const double sqr_distance = dist_x * dist_x + dist_y * dist_y + dist_z * dist_z;
245-
if (sqr_distance < distance_threshold * distance_threshold * downsize_ratio_z_axis_) {
244+
const double sqr_distance = dist_x * dist_x + dist_y * dist_y +
245+
dist_z * dist_z * downsize_ratio_z_axis_ * downsize_ratio_z_axis_;
246+
if (sqr_distance < distance_threshold * distance_threshold) {
246247
return true;
247248
}
248249
}

0 commit comments

Comments
 (0)