310 lines
9.1 KiB
C++
310 lines
9.1 KiB
C++
|
|
#include "btBulletFileLoader.h"
|
|
#include "btBulletFile.h"
|
|
|
|
#include "btBulletDynamicsCommon.h"
|
|
|
|
btBulletFileLoader::btBulletFileLoader(btDynamicsWorld* world)
|
|
:m_dynamicsWorld(world),
|
|
m_verboseDumpAllTypes(false)
|
|
{
|
|
}
|
|
|
|
bool btBulletFileLoader::loadFileFromMemory( char* fileName)
|
|
{
|
|
bParse::btBulletFile* bulletFile2 = new bParse::btBulletFile("testFile.bullet");
|
|
|
|
bool result = loadFileFromMemory(bulletFile2);
|
|
|
|
delete bulletFile2;
|
|
|
|
return result;
|
|
|
|
}
|
|
|
|
|
|
|
|
bool btBulletFileLoader::loadFileFromMemory( char* memoryBuffer, int len)
|
|
{
|
|
bParse::btBulletFile* bulletFile2 = new bParse::btBulletFile(memoryBuffer,len);
|
|
|
|
bool result = loadFileFromMemory(bulletFile2);
|
|
|
|
delete bulletFile2;
|
|
|
|
return result;
|
|
}
|
|
|
|
|
|
bool btBulletFileLoader::loadFileFromMemory( bParse::btBulletFile* bulletFile2)
|
|
{
|
|
|
|
|
|
bool ok = (bulletFile2->getFlags()& bParse::FD_OK)!=0;
|
|
|
|
if (ok)
|
|
bulletFile2->parse(m_verboseDumpAllTypes);
|
|
else
|
|
return false;
|
|
|
|
if (m_verboseDumpAllTypes)
|
|
{
|
|
bulletFile2->dumpChunks(bulletFile2->getFileDNA());
|
|
}
|
|
|
|
int i;
|
|
btHashMap<btHashPtr,btCollisionShape*> shapeMap;
|
|
|
|
for (i=0;i<bulletFile2->m_collisionShapes.size();i++)
|
|
{
|
|
btCollisionShapeData* shapeData = (btCollisionShapeData*)bulletFile2->m_collisionShapes[i];
|
|
switch (shapeData->m_shapeType)
|
|
{
|
|
case CYLINDER_SHAPE_PROXYTYPE:
|
|
case CAPSULE_SHAPE_PROXYTYPE:
|
|
case BOX_SHAPE_PROXYTYPE:
|
|
case SPHERE_SHAPE_PROXYTYPE:
|
|
case MULTI_SPHERE_SHAPE_PROXYTYPE:
|
|
case CONVEX_HULL_SHAPE_PROXYTYPE:
|
|
{
|
|
btConvexInternalShapeData* bsd = (btConvexInternalShapeData*)shapeData;
|
|
btVector3 implicitShapeDimensions;
|
|
implicitShapeDimensions.deSerialize(bsd->m_implicitShapeDimensions);
|
|
btVector3 margin(bsd->m_collisionMargin,bsd->m_collisionMargin,bsd->m_collisionMargin);
|
|
btCollisionShape* shape = 0;
|
|
switch (shapeData->m_shapeType)
|
|
{
|
|
case BOX_SHAPE_PROXYTYPE:
|
|
{
|
|
shape = createBoxShape(implicitShapeDimensions+margin);
|
|
break;
|
|
}
|
|
case SPHERE_SHAPE_PROXYTYPE:
|
|
{
|
|
shape = createSphereShape(implicitShapeDimensions.getX());
|
|
break;
|
|
}
|
|
case CAPSULE_SHAPE_PROXYTYPE:
|
|
{
|
|
shape = createCapsuleShape(implicitShapeDimensions.getX(),implicitShapeDimensions.getY());
|
|
break;
|
|
}
|
|
case CYLINDER_SHAPE_PROXYTYPE:
|
|
{
|
|
btVector3 halfExtents = implicitShapeDimensions+margin;
|
|
|
|
shape = createCylinderShapeY(halfExtents.getX(),halfExtents.getY());
|
|
break;
|
|
}
|
|
case MULTI_SPHERE_SHAPE_PROXYTYPE:
|
|
{
|
|
btMultiSphereShapeData* mss = (btMultiSphereShapeData*)bsd;
|
|
int numSpheres = mss->m_localPositionArraySize;
|
|
|
|
btAlignedObjectArray<btVector3> tmpPos;
|
|
btAlignedObjectArray<btScalar> radii;
|
|
radii.resize(numSpheres);
|
|
tmpPos.resize(numSpheres);
|
|
for (int i=0;i<numSpheres;i++)
|
|
{
|
|
tmpPos[i].deSerialize(mss->m_localPositionArrayPtr[i].m_pos);
|
|
radii[i] = mss->m_localPositionArrayPtr[i].m_radius;
|
|
}
|
|
shape = new btMultiSphereShape(&tmpPos[0],&radii[0],numSpheres);
|
|
break;
|
|
}
|
|
case CONVEX_HULL_SHAPE_PROXYTYPE:
|
|
{
|
|
btConvexHullShapeData* convexData = (btConvexHullShapeData*)bsd;
|
|
int numPoints = convexData->m_numUnscaledPoints;
|
|
|
|
btAlignedObjectArray<btVector3> tmpPoints;
|
|
tmpPoints.resize(numPoints);
|
|
for (int i=0;i<numPoints;i++)
|
|
{
|
|
tmpPoints[i].deSerialize(convexData->m_unscaledPointsPtr[i]);
|
|
}
|
|
shape = new btConvexHullShape(&tmpPoints[0].getX(),numPoints,sizeof(btVector3));
|
|
break;
|
|
}
|
|
default:
|
|
{
|
|
printf("error: cannot create shape type (%d)\n",shapeData->m_shapeType);
|
|
}
|
|
}
|
|
|
|
if (shape)
|
|
{
|
|
shape->setMargin(bsd->m_collisionMargin);
|
|
btVector3 localScaling;
|
|
localScaling.deSerialize(bsd->m_localScaling);
|
|
shape->setLocalScaling(localScaling);
|
|
|
|
shapeMap.insert(shapeData,shape);
|
|
}
|
|
break;
|
|
}
|
|
case TRIANGLE_MESH_SHAPE_PROXYTYPE:
|
|
{
|
|
btTriangleMeshShapeData* trimesh = (btTriangleMeshShapeData*)shapeData;
|
|
btTriangleIndexVertexArray* meshInterface = new btTriangleIndexVertexArray();
|
|
for (int i=0;i<trimesh->m_meshInterface.m_numMeshParts;i++)
|
|
{
|
|
btIndexedMesh meshPart;
|
|
if (trimesh->m_meshInterface.m_meshPartsPtr[i].m_indices32)
|
|
{
|
|
meshPart.m_indexType = PHY_INTEGER;
|
|
meshPart.m_triangleIndexStride = 3*sizeof(int);
|
|
meshPart.m_triangleIndexBase = (const unsigned char*)trimesh->m_meshInterface.m_meshPartsPtr[i].m_indices32;
|
|
} else
|
|
{
|
|
meshPart.m_indexType = PHY_SHORT;
|
|
meshPart.m_triangleIndexStride = 3*sizeof(short int);
|
|
meshPart.m_triangleIndexBase = (const unsigned char*)trimesh->m_meshInterface.m_meshPartsPtr[i].m_indices16;
|
|
}
|
|
|
|
if (trimesh->m_meshInterface.m_meshPartsPtr[i].m_vertices3f)
|
|
{
|
|
meshPart.m_vertexType = PHY_FLOAT;
|
|
meshPart.m_vertexStride = sizeof(btVector3FloatData);
|
|
meshPart.m_vertexBase = (const unsigned char*)trimesh->m_meshInterface.m_meshPartsPtr[i].m_vertices3f;
|
|
} else
|
|
{
|
|
meshPart.m_vertexType = PHY_DOUBLE;
|
|
meshPart.m_vertexStride = sizeof(btVector3DoubleData);
|
|
meshPart.m_vertexBase = (const unsigned char*)trimesh->m_meshInterface.m_meshPartsPtr[i].m_vertices3d;
|
|
}
|
|
meshPart.m_numTriangles = trimesh->m_meshInterface.m_meshPartsPtr[i].m_numTriangles;
|
|
meshPart.m_numVertices = trimesh->m_meshInterface.m_meshPartsPtr[i].m_numVertices;
|
|
|
|
meshInterface->addIndexedMesh(meshPart);
|
|
}
|
|
btVector3 scaling; scaling.deSerialize(trimesh->m_meshInterface.m_scaling);
|
|
meshInterface->setScaling(scaling);
|
|
|
|
btBvhTriangleMeshShape* trimeshShape = new btBvhTriangleMeshShape(meshInterface,true);
|
|
trimeshShape->setMargin(trimesh->m_collisionMargin);
|
|
shapeMap.insert(shapeData,trimeshShape);
|
|
|
|
//printf("trimesh->m_collisionMargin=%f\n",trimesh->m_collisionMargin);
|
|
break;
|
|
}
|
|
default:
|
|
{
|
|
printf("unsupported shape type (%d)\n",shapeData->m_shapeType);
|
|
}
|
|
}
|
|
|
|
}
|
|
for (i=0;i<bulletFile2->m_rigidBodies.size();i++)
|
|
{
|
|
btRigidBodyData* colObjData = (btRigidBodyData*)bulletFile2->m_rigidBodies[i];
|
|
btScalar mass = colObjData->m_inverseMass? 1.f/colObjData->m_inverseMass : 0.f;
|
|
btVector3 localInertia;
|
|
localInertia.setZero();
|
|
btCollisionShape** shapePtr = shapeMap.find(colObjData->m_collisionObjectData.m_collisionShape);
|
|
if (shapePtr && *shapePtr)
|
|
{
|
|
btTransform startTransform;
|
|
startTransform.deSerialize(colObjData->m_collisionObjectData.m_worldTransform);
|
|
|
|
btCollisionShape* shape = (btCollisionShape*)*shapePtr;
|
|
|
|
if (mass)
|
|
{
|
|
shape->calculateLocalInertia(mass,localInertia);
|
|
}
|
|
|
|
bool isDynamic = mass!=0.f;
|
|
createRigidBody(isDynamic,mass,startTransform,shape);
|
|
|
|
} else
|
|
{
|
|
printf("error: no shape found\n");
|
|
}
|
|
}
|
|
|
|
for (i=0;i<bulletFile2->m_collisionObjects.size();i++)
|
|
{
|
|
btCollisionObjectData* colObjData = (btCollisionObjectData*)bulletFile2->m_collisionObjects[i];
|
|
printf("bla");
|
|
}
|
|
return false;
|
|
}
|
|
|
|
btTypedConstraint* btBulletFileLoader::createUniversalD6Constraint(class btRigidBody* body0,class btRigidBody* otherBody,
|
|
btTransform& localAttachmentFrameRef,
|
|
btTransform& localAttachmentOther,
|
|
const btVector3& linearMinLimits,
|
|
const btVector3& linearMaxLimits,
|
|
const btVector3& angularMinLimits,
|
|
const btVector3& angularMaxLimits,
|
|
bool disableCollisionsBetweenLinkedBodies)
|
|
{
|
|
return 0;
|
|
}
|
|
|
|
btRigidBody* btBulletFileLoader::createRigidBody(bool isDynamic, float mass, const btTransform& startTransform,btCollisionShape* shape)
|
|
{
|
|
btVector3 localInertia;
|
|
|
|
if (mass)
|
|
shape->calculateLocalInertia(mass,localInertia);
|
|
|
|
btRigidBody* body = new btRigidBody(mass,0,shape,localInertia);
|
|
body->setWorldTransform(startTransform);
|
|
|
|
m_dynamicsWorld->addRigidBody(body);
|
|
|
|
return body;
|
|
}
|
|
|
|
btCollisionShape* btBulletFileLoader::createPlaneShape(const btVector3& planeNormal,btScalar planeConstant)
|
|
{
|
|
return 0;
|
|
}
|
|
btCollisionShape* btBulletFileLoader::createBoxShape(const btVector3& halfExtents)
|
|
{
|
|
return new btBoxShape(halfExtents);
|
|
}
|
|
btCollisionShape* btBulletFileLoader::createSphereShape(btScalar radius)
|
|
{
|
|
return new btSphereShape(radius);
|
|
}
|
|
|
|
btCollisionShape* btBulletFileLoader::createCapsuleShape(btScalar radius, btScalar height)
|
|
{
|
|
return new btCapsuleShape(radius,height);
|
|
}
|
|
|
|
|
|
|
|
btCollisionShape* btBulletFileLoader::createCylinderShapeY(btScalar radius,btScalar height)
|
|
{
|
|
return new btCylinderShape(btVector3(radius,height,radius));
|
|
}
|
|
btTriangleMesh* btBulletFileLoader::createTriangleMeshContainer()
|
|
{
|
|
return 0;
|
|
}
|
|
btCollisionShape* btBulletFileLoader::createBvhTriangleMeshShape(btTriangleMesh* trimesh)
|
|
{
|
|
return 0;
|
|
}
|
|
btCollisionShape* btBulletFileLoader::createConvexTriangleMeshShape(btTriangleMesh* trimesh)
|
|
{
|
|
return 0;
|
|
}
|
|
btCollisionShape* btBulletFileLoader::createGimpactShape(btTriangleMesh* trimesh)
|
|
{
|
|
return 0;
|
|
}
|
|
btConvexHullShape* btBulletFileLoader::createConvexHullShape()
|
|
{
|
|
return 0;
|
|
}
|
|
|
|
btCompoundShape* btBulletFileLoader::createCompoundShape()
|
|
{
|
|
return 0;
|
|
} |