CSPublic/Blocks3D
1
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

Made physics sync velocity

Browse Source
This commit is contained in:
Vulpovile
2022-10-06 11:38:36 -07:00
parent 11b3c861d9
commit ecbbc7c8e8
1 changed files with 14 additions and 2 deletions
Download Patch File Download Diff File Expand all files Collapse all files

16
src/source/XplicitNgine/XplicitNgine.cpp
View File

@@ -118,10 +118,13 @@ void XplicitNgine::createBody(PartInstance* partInstance)
// calculate collisions // calculate collisions
//dSpaceCollide (physSpace,0,&collisionCallback); //dSpaceCollide (physSpace,0,&collisionCallback);
Vector3 partSize = partInstance->getSize();
Vector3 partPosition = partInstance->getPosition();
if(partInstance->physBody == NULL) if(partInstance->physBody == NULL)
{ {
Vector3 partSize = partInstance->getSize();
Vector3 partPosition = partInstance->getPosition();
Vector3 velocity = partInstance->getVelocity();
Vector3 rotVelocity = partInstance->getRotVelocity();
// init body // init body
partInstance->physBody = dBodyCreate(physWorld); partInstance->physBody = dBodyCreate(physWorld);
dBodySetData(partInstance->physBody, partInstance); dBodySetData(partInstance->physBody, partInstance);
@@ -168,6 +171,9 @@ void XplicitNgine::createBody(PartInstance* partInstance)
partPosition.y, partPosition.y,
partPosition.z); partPosition.z);
dBodySetLinearVel(partInstance->physBody, velocity.x, velocity.y, velocity.z);
dBodySetAngularVel(partInstance->physBody, rotVelocity.x, rotVelocity.y, rotVelocity.z);
Matrix3 g3dRot = partInstance->getCFrame().rotation; Matrix3 g3dRot = partInstance->getCFrame().rotation;
float rotation [12] = { g3dRot[0][0], g3dRot[0][1], g3dRot[0][2], 0, float rotation [12] = { g3dRot[0][0], g3dRot[0][1], g3dRot[0][2], 0,
g3dRot[1][0], g3dRot[1][1], g3dRot[1][2], 0, g3dRot[1][0], g3dRot[1][1], g3dRot[1][2], 0,
@@ -183,6 +189,12 @@ void XplicitNgine::createBody(PartInstance* partInstance)
} else { } else {
if(!partInstance->isAnchored()) if(!partInstance->isAnchored())
{ {
const dReal* velocity = dBodyGetLinearVel(partInstance->physBody);
const dReal* rotVelocity = dBodyGetAngularVel(partInstance->physBody);
partInstance->setVelocity(Vector3(velocity[0],velocity[1],velocity[2]));
partInstance->setRotVelocity(Vector3(rotVelocity[0],rotVelocity[1],rotVelocity[2]));
const dReal* physPosition = dBodyGetPosition(partInstance->physBody); const dReal* physPosition = dBodyGetPosition(partInstance->physBody);
// TODO: Rotation code // TODO: Rotation code