From 2524ea5bc0b4a213f2467953f2bad4cafb26b3c7 Mon Sep 17 00:00:00 2001
From: Justin Carpentier <justin.carpentier@inria.fr>
Date: Sun, 5 Jun 2022 17:06:18 +0200
Subject: [PATCH] core: fix assert

`distance_lower_bound` may be initialized with a lower value than the one contained in sqrDistLowerBound.
---
 src/collision_node.cpp | 4 ++--
 1 file changed, 2 insertions(+), 2 deletions(-)

diff --git a/src/collision_node.cpp b/src/collision_node.cpp
index b31bc0568..cae212656 100644
--- 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);
       }
     }