Use safeNormalize, in case a both objects have identical origin.

Fixes Issue 2021
This commit is contained in:
erwincoumans
2018-12-22 10:59:00 -08:00
parent 9c4136da16
commit 7ce9ad23fb

View File

@@ -31,8 +31,8 @@ bool btGjkEpaPenetrationDepthSolver::calcPenDepth(btSimplexSolverInterface& simp
(void)simplexSolver;
btVector3 guessVectors[] = {
btVector3(transformB.getOrigin() - transformA.getOrigin()).normalized(),
btVector3(transformA.getOrigin() - transformB.getOrigin()).normalized(),
btVector3(transformB.getOrigin() - transformA.getOrigin()).safeNormalize(),
btVector3(transformA.getOrigin() - transformB.getOrigin()).safeNormalize(),
btVector3(0, 0, 1),
btVector3(0, 1, 0),
btVector3(1, 0, 0),