Corrected scorePose check (ros-navigation#1404)

Signed-off-by: Aitor Miguel Blanco <aitormibl@gmail.com>
gimait · Mar 17, 2020 · d1b2754 · d1b2754
1 parent 8a8810c
commit d1b2754
Showing 1 changed file with 1 addition and 1 deletion.
diff --git a/nav2_costmap_2d/src/collision_checker.cpp b/nav2_costmap_2d/src/collision_checker.cpp
@@ -51,7 +51,7 @@ bool CollisionChecker::isCollisionFree(
   const geometry_msgs::msg::Pose2D & pose)
 {
   try {
-    if (scorePose(pose) < 0) {
+    if (scorePose(pose) > INSCRIBED_INFLATED_OBSTACLE) {
       return false;
     }
     return true;