We read every piece of feedback, and take your input very seriously.
To see all available qualifiers, see our documentation.
1 parent ae997bd commit 2da121fCopy full SHA for 2da121f
localization/yabloc/yabloc_common/src/extract_line_segments.cpp
@@ -25,7 +25,8 @@ pcl::PointCloud<pcl::PointNormal> extract_near_line_segments(
25
26
// All line segments contained in a square with max_range on one side must be taken out,
27
// so pick up those that are closer than the **diagonals** of the square.
28
- auto check_intersection = [max_range, pose_vector](const pcl::PointNormal & pn) -> bool {
+ auto check_intersection = [sqrt_two, max_range,
29
+ pose_vector](const pcl::PointNormal & pn) -> bool {
30
const Eigen::Vector3f from = pn.getVector3fMap() - pose_vector;
31
const Eigen::Vector3f to = pn.getNormalVector3fMap() - pose_vector;
32
0 commit comments