diff --git a/include/hpp/fcl/narrowphase/gjk.h b/include/hpp/fcl/narrowphase/gjk.h index f6baebc0495cb14f91561eecc0b802a597b71830..07d8a1646398379503d5512ddce33da4e468beb8 100644 --- a/include/hpp/fcl/narrowphase/gjk.h +++ b/include/hpp/fcl/narrowphase/gjk.h @@ -305,6 +305,9 @@ public: void initialize(); + Status evaluate(GJK& gjk, const Vec3f& guess); + +private: bool getEdgeDist(SimplexF* face, SimplexV* a, SimplexV* b, FCL_REAL& dist); SimplexF* newFace(SimplexV* a, SimplexV* b, SimplexV* vertex, bool forced); @@ -312,8 +315,6 @@ public: /// @brief Find the best polytope face to split SimplexF* findBest(); - Status evaluate(GJK& gjk, const Vec3f& guess); - /// @brief the goal is to add a face connecting vertex w and face edge f[e] bool expand(size_t pass, SimplexV* w, SimplexF* f, size_t e, SimplexHorizon& horizon); };