//struct CreateFunc :public btCollisionAlgorithmCreateFunc
//{
// virtual btCollisionAlgorithm* CreateCollisionAlgorithm(btCollisionAlgorithmConstructionInfo& ci, btCollisionObject* body0,btCollisionObject* body1)
// {
// void* mem = ci.m_dispatcher1.allocateCollisionAlgorithm(sizeof(btGImpactCollisionAlgorithm));
// return new(mem) btGImpactCollisionAlgorithm(ci,body0,body1);
// }
//};
//! Use this function for register the algorithm externally
public static void RegisterAlgorithm(CollisionDispatcher dispatcher)
{
GImpactCreateFunc s_gimpact_cf = new GImpactCreateFunc();
int i;
for (i = 0; i < (int)BroadphaseNativeTypes.MAX_BROADPHASE_COLLISION_TYPES; i++)
{
dispatcher.RegisterCollisionCreateFunc((int)BroadphaseNativeTypes.GIMPACT_SHAPE_PROXYTYPE, i, s_gimpact_cf);
}
for (i = 0; i < (int)BroadphaseNativeTypes.MAX_BROADPHASE_COLLISION_TYPES; i++)
{
dispatcher.RegisterCollisionCreateFunc(i, (int)BroadphaseNativeTypes.GIMPACT_SHAPE_PROXYTYPE, s_gimpact_cf);
}
}
public void NearCallback(BroadphasePair collisionPair, CollisionDispatcher dispatcher, DispatcherInfo dispatchInfo)
{
CollisionObject colObj0 = collisionPair.m_pProxy0.GetClientObject() as CollisionObject;
CollisionObject colObj1 = collisionPair.m_pProxy1.GetClientObject() as CollisionObject;
if (dispatcher.NeedsCollision(colObj0, colObj1))
{
//dispatcher will keep algorithms persistent in the collision pair
if (collisionPair.m_algorithm == null)
{
collisionPair.m_algorithm = dispatcher.FindAlgorithm(colObj0, colObj1, null);
}
if (collisionPair.m_algorithm != null)
{
ManifoldResult contactPointResult = dispatcher.GetNewManifoldResult(colObj0, colObj1);
if (dispatchInfo.GetDispatchFunc() == DispatchFunc.DISPATCH_DISCRETE)
{
//discrete collision detection query
collisionPair.m_algorithm.ProcessCollision(colObj0, colObj1, dispatchInfo, contactPointResult);
}
else
{
//continuous collision detection query, time of impact (toi)
float toi = collisionPair.m_algorithm.CalculateTimeOfImpact(colObj0, colObj1, dispatchInfo, contactPointResult);
if (dispatchInfo.GetTimeOfImpact() > toi)
{
dispatchInfo.SetTimeOfImpact(toi);
}
}
#if DEBUG
if (BulletGlobals.g_streamWriter != null && BulletGlobals.debugDispatcher)
{
BulletGlobals.g_streamWriter.WriteLine("NearCallback[{0}][{1}][{2}]", contactPointResult.GetBody0Internal().GetUserPointer(), contactPointResult.GetBody1Internal().GetUserPointer(), contactPointResult.GetPersistentManifold().GetNumContacts());
}
#endif
dispatcher.FreeManifoldResult(contactPointResult);
}
}
}
public void Initialize(DispatcherInfo dispatchInfo, CollisionDispatcher dispatcher)
{
m_dispatchInfo = dispatchInfo;
m_dispatcher = dispatcher;
}
public CollisionPairCallback(DispatcherInfo dispatchInfo, CollisionDispatcher dispatcher)
{
m_dispatchInfo = dispatchInfo;
m_dispatcher = dispatcher;
}
