forked from bartvdbraak/blender
67 lines
1.9 KiB
C++
67 lines
1.9 KiB
C++
#include "SumoPHYCallbackBridge.h"
|
|
#include "PHY_IPhysicsController.h"
|
|
#include "SM_Object.h"
|
|
|
|
|
|
SumoPHYCallbackBridge::SumoPHYCallbackBridge(void* clientData,PHY_ResponseCallback phyCallback)
|
|
:m_orgClientData(clientData),
|
|
m_phyCallback(phyCallback)
|
|
{
|
|
|
|
}
|
|
DT_Bool SumoPHYCallbackBridge::StaticSolidToPHYCallback(void *client_data,
|
|
void *client_object1,
|
|
void *client_object2,
|
|
const DT_CollData *coll_data)
|
|
{
|
|
SumoPHYCallbackBridge* bridge = static_cast<SumoPHYCallbackBridge*>(client_data);
|
|
bridge->SolidToPHY(client_object1,client_object2,coll_data);
|
|
return false;
|
|
}
|
|
|
|
DT_Bool SumoPHYCallbackBridge::SolidToPHY(void *client_object1,
|
|
void *client_object2,
|
|
const DT_CollData *coll_data)
|
|
{
|
|
|
|
SM_Object* smObject1 = static_cast<SM_Object*>(client_object1);
|
|
SM_Object* smObject2 = static_cast<SM_Object*>(client_object2);
|
|
|
|
PHY_IPhysicsController* ctrl1 = static_cast<PHY_IPhysicsController*>(smObject1->getPhysicsClientObject());
|
|
PHY_IPhysicsController* ctrl2 = static_cast<PHY_IPhysicsController*>(smObject2->getPhysicsClientObject());
|
|
|
|
if (!ctrl1 || !ctrl2)
|
|
{
|
|
//todo: check which objects are not linked up properly
|
|
return false;
|
|
}
|
|
if (coll_data)
|
|
{
|
|
PHY_CollData phyCollData;
|
|
|
|
phyCollData.m_point1[0] = coll_data->point1[0];
|
|
phyCollData.m_point1[1] = coll_data->point1[1];
|
|
phyCollData.m_point1[2] = coll_data->point1[2];
|
|
phyCollData.m_point1[3] = 0.f;
|
|
|
|
phyCollData.m_point2[0] = coll_data->point2[0];
|
|
phyCollData.m_point2[1] = coll_data->point2[1];
|
|
phyCollData.m_point2[2] = coll_data->point2[2];
|
|
phyCollData.m_point2[3] = 0.f;
|
|
|
|
phyCollData.m_normal[0] = coll_data->normal[0];
|
|
phyCollData.m_normal[1] = coll_data->normal[1];
|
|
phyCollData.m_normal[2] = coll_data->normal[2];
|
|
phyCollData.m_normal[3] = 0.f;
|
|
|
|
|
|
return m_phyCallback(m_orgClientData,
|
|
ctrl1,ctrl2,&phyCollData);
|
|
}
|
|
|
|
return m_phyCallback(m_orgClientData,
|
|
ctrl1,ctrl2,0);
|
|
|
|
}
|
|
|