diff --git a/include/hpp/fcl/narrowphase/narrowphase.h b/include/hpp/fcl/narrowphase/narrowphase.h index 6dbbe89b5b781c148fdae91d6e7765c266f86994..303939150e52ba096ce833f52bc60ed3d888b2de 100644 --- a/include/hpp/fcl/narrowphase/narrowphase.h +++ b/include/hpp/fcl/narrowphase/narrowphase.h @@ -138,7 +138,7 @@ namespace fcl distance = -epa.depth; normal = -epa.normal; p1 = p2 = tf1.transform(w0 - epa.normal*(epa.depth *0.5)); - assert (distance <= 0); + assert (distance <= 1e-6); break; } case details::GJK::Valid: