core: fix assert

`distance_lower_bound` may be initialized with a lower value than the one contained in sqrDistLowerBound.
coal-library · Jun 5, 2022 · 2524ea5 · 2524ea5
1 parent 19ed036
commit 2524ea5
Showing 1 changed file with 2 additions and 2 deletions.
diff --git a/src/collision_node.cpp b/src/collision_node.cpp
@@ -59,8 +59,8 @@ void collide(CollisionTraversalNodeBase* node, const CollisionRequest& request,
       if (sqrDistLowerBound == 0) {
         assert(result.distance_lower_bound <= 0);
       } else {
-        assert(fabs(sqrDistLowerBound -
-                    result.distance_lower_bound * result.distance_lower_bound) <
+        assert(result.distance_lower_bound * result.distance_lower_bound -
+                   sqrDistLowerBound <
                1e-8);
       }
     }