Fix issue in SAT algorithm
This commit is contained in:
parent
6bcb586d52
commit
528d7bfd45
|
@ -40,8 +40,8 @@
|
||||||
using namespace reactphysics3d;
|
using namespace reactphysics3d;
|
||||||
|
|
||||||
// Static variables initialization
|
// Static variables initialization
|
||||||
const decimal SATAlgorithm::SEPARATING_AXIS_RELATIVE_TOLERANCE = decimal(1.02);
|
const decimal SATAlgorithm::SEPARATING_AXIS_RELATIVE_TOLERANCE = decimal(1.002);
|
||||||
const decimal SATAlgorithm::SEPARATING_AXIS_ABSOLUTE_TOLERANCE = decimal(0.005);
|
const decimal SATAlgorithm::SEPARATING_AXIS_ABSOLUTE_TOLERANCE = decimal(0.0005);
|
||||||
|
|
||||||
// Constructor
|
// Constructor
|
||||||
SATAlgorithm::SATAlgorithm(MemoryAllocator& memoryAllocator) : mMemoryAllocator(memoryAllocator) {
|
SATAlgorithm::SATAlgorithm(MemoryAllocator& memoryAllocator) : mMemoryAllocator(memoryAllocator) {
|
||||||
|
@ -698,7 +698,7 @@ bool SATAlgorithm::testCollisionConvexPolyhedronVsConvexPolyhedron(NarrowPhaseIn
|
||||||
|
|
||||||
// We use penetration axis of polygon 1
|
// We use penetration axis of polygon 1
|
||||||
isMinPenetrationFaceNormal = true;
|
isMinPenetrationFaceNormal = true;
|
||||||
minPenetrationDepth = penetrationDepth1;
|
minPenetrationDepth = std::min(penetrationDepth1, penetrationDepth2);
|
||||||
minFaceIndex = faceIndex1;
|
minFaceIndex = faceIndex1;
|
||||||
isMinPenetrationFaceNormalPolyhedron1 = true;
|
isMinPenetrationFaceNormalPolyhedron1 = true;
|
||||||
}
|
}
|
||||||
|
@ -706,7 +706,7 @@ bool SATAlgorithm::testCollisionConvexPolyhedronVsConvexPolyhedron(NarrowPhaseIn
|
||||||
|
|
||||||
// We use penetration axis of polygon 2
|
// We use penetration axis of polygon 2
|
||||||
isMinPenetrationFaceNormal = true;
|
isMinPenetrationFaceNormal = true;
|
||||||
minPenetrationDepth = penetrationDepth2;
|
minPenetrationDepth = std::min(penetrationDepth1, penetrationDepth2);
|
||||||
minFaceIndex = faceIndex2;
|
minFaceIndex = faceIndex2;
|
||||||
isMinPenetrationFaceNormalPolyhedron1 = false;
|
isMinPenetrationFaceNormalPolyhedron1 = false;
|
||||||
}
|
}
|
||||||
|
|
Loading…
Reference in New Issue
Block a user