Fix calculation of startPt for perturbed object A.

Fixes #1563.
This commit is contained in:
Stephen Sinclair
2018-02-16 11:57:16 -03:00
parent e87060dcf4
commit 58310bd21d

View File

@@ -259,7 +259,7 @@ struct btPerturbedContactResult : public btManifoldResult
btVector3 endPtOrg = pointInWorld + normalOnBInWorld*orgDepth; btVector3 endPtOrg = pointInWorld + normalOnBInWorld*orgDepth;
endPt = (m_unPerturbedTransform*m_transformA.inverse())(endPtOrg); endPt = (m_unPerturbedTransform*m_transformA.inverse())(endPtOrg);
newDepth = (endPt - pointInWorld).dot(normalOnBInWorld); newDepth = (endPt - pointInWorld).dot(normalOnBInWorld);
startPt = endPt+normalOnBInWorld*newDepth; startPt = endPt - normalOnBInWorld*newDepth;
} else } else
{ {
endPt = pointInWorld + normalOnBInWorld*orgDepth; endPt = pointInWorld + normalOnBInWorld*orgDepth;