diff --git a/src/obstacle_detection_normals_alg.cpp b/src/obstacle_detection_normals_alg.cpp index 1f54855dd9259ebcfa1e2ccca5fb6ba521f07f2c..0bdd89d7e773302e7ffadc8ce563412bc0dc5abf 100644 --- a/src/obstacle_detection_normals_alg.cpp +++ b/src/obstacle_detection_normals_alg.cpp @@ -62,7 +62,7 @@ void ObstacleDetectionNormalsAlgorithm::cloud_all(const pcl::PointCloud<pcl::Poi { for (size_t colIndex=0; colIndex<cloud_out->width; ++colIndex, ++pointIndex) { - if (cloud_out->points[pointIndex].x > this->config_.filter_min_dist) + if (fabs(cloud_out->points[pointIndex].x) > this->config_.filter_min_dist) { if (fabs(cloud_out->points[pointIndex].normal_z) > cos(this->config_.max_inc)) {