diff --git a/src/narrowphase/gjk.cpp b/src/narrowphase/gjk.cpp index 86ef02e94713c3988cba0e9a1ff6c52989992e57..af596e66c8fb1a245e59240480ebde2eefc1af16 100644 --- a/src/narrowphase/gjk.cpp +++ b/src/narrowphase/gjk.cpp @@ -419,9 +419,9 @@ GJK::Status GJK::evaluate(const MinkowskiDiff& shape_, const Vec3f& guess) void GJK::getSupport(const Vec3f& d, bool dIsNormalized, SimplexV& sv) const { - if (dIsNormalized) sv.d = d; - else sv.d.noalias() = d.normalized(); - shape.support(sv.d, true, sv.w); + // Was sv.d.noalias() = d.normalized(); + sv.d.noalias() = d; + shape.support(sv.d, dIsNormalized, sv.w); } void GJK::removeVertex(Simplex& simplex)