2017-08-01 12:30:58 +00:00
|
|
|
/*
|
|
|
|
Bullet Continuous Collision Detection and Physics Library
|
|
|
|
Copyright (c) 2003-2006 Erwin Coumans http://continuousphysics.com/Bullet/
|
|
|
|
|
|
|
|
This software is provided 'as-is', without any express or implied warranty.
|
|
|
|
In no event will the authors be held liable for any damages arising from the use of this software.
|
|
|
|
Permission is granted to anyone to use this software for any purpose,
|
|
|
|
including commercial applications, and to alter it and redistribute it freely,
|
|
|
|
subject to the following restrictions:
|
|
|
|
|
|
|
|
1. The origin of this software must not be misrepresented; you must not claim that you wrote the original software. If you use this software in a product, an acknowledgment in the product documentation would be appreciated but is not required.
|
|
|
|
2. Altered source versions must be plainly marked as such, and must not be misrepresented as being the original software.
|
|
|
|
3. This notice may not be removed or altered from any source distribution.
|
|
|
|
*/
|
|
|
|
|
|
|
|
#ifndef BT_GJK_PAIR_DETECTOR_H
|
|
|
|
#define BT_GJK_PAIR_DETECTOR_H
|
|
|
|
|
|
|
|
#include "btDiscreteCollisionDetectorInterface.h"
|
|
|
|
#include "BulletCollision/CollisionShapes/btCollisionMargin.h"
|
|
|
|
|
|
|
|
class btConvexShape;
|
|
|
|
#include "btSimplexSolverInterface.h"
|
|
|
|
class btConvexPenetrationDepthSolver;
|
|
|
|
|
|
|
|
/// btGjkPairDetector uses GJK to implement the btDiscreteCollisionDetectorInterface
|
|
|
|
class btGjkPairDetector : public btDiscreteCollisionDetectorInterface
|
|
|
|
{
|
2019-01-03 13:26:51 +00:00
|
|
|
btVector3 m_cachedSeparatingAxis;
|
|
|
|
btConvexPenetrationDepthSolver* m_penetrationDepthSolver;
|
2017-08-01 12:30:58 +00:00
|
|
|
btSimplexSolverInterface* m_simplexSolver;
|
|
|
|
const btConvexShape* m_minkowskiA;
|
|
|
|
const btConvexShape* m_minkowskiB;
|
2019-01-03 13:26:51 +00:00
|
|
|
int m_shapeTypeA;
|
2017-08-01 12:30:58 +00:00
|
|
|
int m_shapeTypeB;
|
2019-01-03 13:26:51 +00:00
|
|
|
btScalar m_marginA;
|
|
|
|
btScalar m_marginB;
|
2017-08-01 12:30:58 +00:00
|
|
|
|
2019-01-03 13:26:51 +00:00
|
|
|
bool m_ignoreMargin;
|
|
|
|
btScalar m_cachedSeparatingDistance;
|
2017-08-01 12:30:58 +00:00
|
|
|
|
|
|
|
public:
|
|
|
|
//some debugging to fix degeneracy problems
|
2019-01-03 13:26:51 +00:00
|
|
|
int m_lastUsedMethod;
|
|
|
|
int m_curIter;
|
|
|
|
int m_degenerateSimplex;
|
|
|
|
int m_catchDegeneracies;
|
|
|
|
int m_fixContactNormalDirection;
|
2017-08-01 12:30:58 +00:00
|
|
|
|
2019-01-03 13:26:51 +00:00
|
|
|
btGjkPairDetector(const btConvexShape* objectA, const btConvexShape* objectB, btSimplexSolverInterface* simplexSolver, btConvexPenetrationDepthSolver* penetrationDepthSolver);
|
|
|
|
btGjkPairDetector(const btConvexShape* objectA, const btConvexShape* objectB, int shapeTypeA, int shapeTypeB, btScalar marginA, btScalar marginB, btSimplexSolverInterface* simplexSolver, btConvexPenetrationDepthSolver* penetrationDepthSolver);
|
|
|
|
virtual ~btGjkPairDetector(){};
|
2017-08-01 12:30:58 +00:00
|
|
|
|
2019-01-03 13:26:51 +00:00
|
|
|
virtual void getClosestPoints(const ClosestPointInput& input, Result& output, class btIDebugDraw* debugDraw, bool swapResults = false);
|
2017-08-01 12:30:58 +00:00
|
|
|
|
2019-01-03 13:26:51 +00:00
|
|
|
void getClosestPointsNonVirtual(const ClosestPointInput& input, Result& output, class btIDebugDraw* debugDraw);
|
2017-08-01 12:30:58 +00:00
|
|
|
|
|
|
|
void setMinkowskiA(const btConvexShape* minkA)
|
|
|
|
{
|
|
|
|
m_minkowskiA = minkA;
|
|
|
|
}
|
|
|
|
|
|
|
|
void setMinkowskiB(const btConvexShape* minkB)
|
|
|
|
{
|
|
|
|
m_minkowskiB = minkB;
|
|
|
|
}
|
2020-01-08 17:05:43 +00:00
|
|
|
void setCachedSeparatingAxis(const btVector3& separatingAxis)
|
2017-08-01 12:30:58 +00:00
|
|
|
{
|
2020-01-08 17:05:43 +00:00
|
|
|
m_cachedSeparatingAxis = separatingAxis;
|
2017-08-01 12:30:58 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
const btVector3& getCachedSeparatingAxis() const
|
|
|
|
{
|
|
|
|
return m_cachedSeparatingAxis;
|
|
|
|
}
|
2019-01-03 13:26:51 +00:00
|
|
|
btScalar getCachedSeparatingDistance() const
|
2017-08-01 12:30:58 +00:00
|
|
|
{
|
|
|
|
return m_cachedSeparatingDistance;
|
|
|
|
}
|
|
|
|
|
2019-01-03 13:26:51 +00:00
|
|
|
void setPenetrationDepthSolver(btConvexPenetrationDepthSolver* penetrationDepthSolver)
|
2017-08-01 12:30:58 +00:00
|
|
|
{
|
|
|
|
m_penetrationDepthSolver = penetrationDepthSolver;
|
|
|
|
}
|
|
|
|
|
|
|
|
///don't use setIgnoreMargin, it's for Bullet's internal use
|
2019-01-03 13:26:51 +00:00
|
|
|
void setIgnoreMargin(bool ignoreMargin)
|
2017-08-01 12:30:58 +00:00
|
|
|
{
|
|
|
|
m_ignoreMargin = ignoreMargin;
|
|
|
|
}
|
|
|
|
};
|
|
|
|
|
2019-01-03 13:26:51 +00:00
|
|
|
#endif //BT_GJK_PAIR_DETECTOR_H
|