Initial commit
This commit is contained in:
296
engines/hpl1/engine/impl/CollideShapeNewton.cpp
Normal file
296
engines/hpl1/engine/impl/CollideShapeNewton.cpp
Normal file
@@ -0,0 +1,296 @@
|
||||
/* ScummVM - Graphic Adventure Engine
|
||||
*
|
||||
* ScummVM is the legal property of its developers, whose names
|
||||
* are too numerous to list here. Please refer to the COPYRIGHT
|
||||
* file distributed with this source distribution.
|
||||
*
|
||||
* This program is free software: you can redistribute it and/or modify
|
||||
* it under the terms of the GNU General Public License as published by
|
||||
* the Free Software Foundation, either version 3 of the License, or
|
||||
* (at your option) any later version.
|
||||
*
|
||||
* This program is distributed in the hope that it will be useful,
|
||||
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||||
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
||||
* GNU General Public License for more details.
|
||||
*
|
||||
* You should have received a copy of the GNU General Public License
|
||||
* along with this program. If not, see <http://www.gnu.org/licenses/>.
|
||||
*
|
||||
*/
|
||||
|
||||
/*
|
||||
* Copyright (C) 2006-2010 - Frictional Games
|
||||
*
|
||||
* This file is part of HPL1 Engine.
|
||||
*/
|
||||
|
||||
#include "hpl1/engine/impl/CollideShapeNewton.h"
|
||||
|
||||
#include "hpl1/engine/physics/PhysicsWorld.h"
|
||||
#include "hpl1/engine/system/low_level_system.h"
|
||||
|
||||
namespace hpl {
|
||||
|
||||
//////////////////////////////////////////////////////////////////////////
|
||||
// CONSTRUCTORS
|
||||
//////////////////////////////////////////////////////////////////////////
|
||||
|
||||
//-----------------------------------------------------------------------
|
||||
|
||||
cCollideShapeNewton::cCollideShapeNewton(eCollideShapeType aType, const cVector3f &avSize,
|
||||
cMatrixf *apOffsetMtx, NewtonWorld *apNewtonWorld,
|
||||
iPhysicsWorld *apWorld)
|
||||
: iCollideShape(apWorld) {
|
||||
mpNewtonCollision = NULL;
|
||||
mpNewtonWorld = apNewtonWorld;
|
||||
mvSize = avSize;
|
||||
mType = aType;
|
||||
|
||||
mfVolume = 0;
|
||||
|
||||
float *pMtx = NULL;
|
||||
cMatrixf mtxTranspose;
|
||||
if (apOffsetMtx) {
|
||||
m_mtxOffset = *apOffsetMtx;
|
||||
mtxTranspose = m_mtxOffset.GetTranspose();
|
||||
|
||||
pMtx = &(mtxTranspose.m[0][0]);
|
||||
} else {
|
||||
m_mtxOffset = cMatrixf::Identity;
|
||||
}
|
||||
|
||||
////////////////////////////////////////////
|
||||
// Create Newton collision
|
||||
|
||||
switch (aType) {
|
||||
case eCollideShapeType_Null:
|
||||
mpNewtonCollision = NewtonCreateNull(apNewtonWorld);
|
||||
break;
|
||||
|
||||
case eCollideShapeType_Box:
|
||||
mpNewtonCollision = NewtonCreateBox(apNewtonWorld,
|
||||
mvSize.x, mvSize.y, mvSize.z,
|
||||
0, pMtx);
|
||||
break;
|
||||
|
||||
case eCollideShapeType_Sphere:
|
||||
mpNewtonCollision = NewtonCreateSphere(apNewtonWorld,
|
||||
mvSize.x, mvSize.y, mvSize.z,
|
||||
0, pMtx);
|
||||
break;
|
||||
|
||||
case eCollideShapeType_Cylinder:
|
||||
mpNewtonCollision = NewtonCreateCylinder(apNewtonWorld,
|
||||
mvSize.x, mvSize.y,
|
||||
0, pMtx);
|
||||
break;
|
||||
|
||||
case eCollideShapeType_Capsule:
|
||||
mpNewtonCollision = NewtonCreateCapsule(apNewtonWorld,
|
||||
mvSize.x, mvSize.y,
|
||||
0, pMtx);
|
||||
break;
|
||||
default:
|
||||
break;
|
||||
}
|
||||
|
||||
////////////////////////////////////////////
|
||||
// Calculate Bounding volume and volume.
|
||||
if (mType == eCollideShapeType_Box) {
|
||||
mBoundingVolume.SetSize(mvSize);
|
||||
|
||||
mfVolume = mvSize.x * mvSize.y * mvSize.z;
|
||||
} else if (mType == eCollideShapeType_Sphere) {
|
||||
mBoundingVolume.SetSize(mvSize * 2);
|
||||
|
||||
mfVolume = (4.0f / 3.0f) * kPif * (mvSize.x * mvSize.x * mvSize.x);
|
||||
} else if (mType == eCollideShapeType_Cylinder ||
|
||||
mType == eCollideShapeType_Capsule) {
|
||||
mBoundingVolume.SetSize(cVector3f(mvSize.y, mvSize.x * 2, mvSize.x * 2));
|
||||
|
||||
// Not gonna be correct for capsule...
|
||||
if (mType == eCollideShapeType_Cylinder)
|
||||
mfVolume = kPif * (mvSize.x * mvSize.x) * mvSize.y;
|
||||
else {
|
||||
// Height of the cylinder part.
|
||||
float fCylHeight = mvSize.y - (mvSize.x * 2);
|
||||
mfVolume = 0;
|
||||
|
||||
// The volume of the cylinder part.
|
||||
if (fCylHeight > 0)
|
||||
mfVolume += kPif * (mvSize.x * mvSize.x) * fCylHeight;
|
||||
|
||||
// The volume of the sphere part.
|
||||
mfVolume += (4.0f / 3.0f) * kPif * (mvSize.x * mvSize.x * mvSize.x);
|
||||
}
|
||||
}
|
||||
|
||||
mBoundingVolume.SetTransform(m_mtxOffset);
|
||||
}
|
||||
|
||||
//-----------------------------------------------------------------------
|
||||
|
||||
cCollideShapeNewton::~cCollideShapeNewton() {
|
||||
// Release Newton Collision
|
||||
if (mpNewtonCollision)
|
||||
NewtonReleaseCollision(mpNewtonWorld, mpNewtonCollision);
|
||||
// Release all subshapes (for compound objects)
|
||||
for (int i = 0; i < (int)mvSubShapes.size(); i++) {
|
||||
mpWorld->DestroyShape(mvSubShapes[i]);
|
||||
}
|
||||
}
|
||||
|
||||
//-----------------------------------------------------------------------
|
||||
|
||||
//////////////////////////////////////////////////////////////////////////
|
||||
// PUBLIC METHODS
|
||||
//////////////////////////////////////////////////////////////////////////
|
||||
|
||||
//-----------------------------------------------------------------------
|
||||
|
||||
iCollideShape *cCollideShapeNewton::GetSubShape(int alIdx) {
|
||||
if (mType == eCollideShapeType_Compound)
|
||||
return mvSubShapes[alIdx];
|
||||
else
|
||||
return this;
|
||||
}
|
||||
|
||||
int cCollideShapeNewton::GetSubShapeNum() {
|
||||
if (mType == eCollideShapeType_Compound)
|
||||
return (int)mvSubShapes.size();
|
||||
else
|
||||
return 1;
|
||||
}
|
||||
|
||||
//-----------------------------------------------------------------------
|
||||
|
||||
cVector3f cCollideShapeNewton::GetInertia(float afMass) {
|
||||
cVector3f vInertia(1, 1, 1);
|
||||
|
||||
// Box
|
||||
if (mType == eCollideShapeType_Box) {
|
||||
float fInv = 1.0f / 12.0f;
|
||||
vInertia = cVector3f(
|
||||
afMass * (mvSize.y * mvSize.y + mvSize.z * mvSize.z) * fInv,
|
||||
afMass * (mvSize.x * mvSize.x + mvSize.z * mvSize.z) * fInv,
|
||||
afMass * (mvSize.x * mvSize.x + mvSize.y * mvSize.y) * fInv);
|
||||
}
|
||||
// Sphere
|
||||
else if (mType == eCollideShapeType_Sphere) {
|
||||
float fI = 0.4f * afMass * mvSize.x * mvSize.x;
|
||||
vInertia = cVector3f(fI, fI, fI);
|
||||
}
|
||||
// Cylinder
|
||||
else if (mType == eCollideShapeType_Cylinder) {
|
||||
float fRadius = mvSize.x;
|
||||
vInertia.x = afMass * (fRadius * fRadius) * (1.0f / 4.0f) + afMass * (mvSize.y * mvSize.y) * (1.0f / 12.0f);
|
||||
vInertia.y = vInertia.x;
|
||||
vInertia.z = afMass * (fRadius * fRadius) * (1.0f / 2.0f);
|
||||
}
|
||||
// Capsule
|
||||
else if (mType == eCollideShapeType_Capsule) {
|
||||
float fRadius = mvSize.x;
|
||||
vInertia.x = afMass * (fRadius * fRadius) * (1.0f / 4.0f) + afMass * (mvSize.y * mvSize.y) * (1.0f / 12.0f);
|
||||
vInertia.y = vInertia.x;
|
||||
vInertia.z = afMass * (fRadius * fRadius) * (1.0f / 2.0f);
|
||||
}
|
||||
// Compound
|
||||
// This is only a very bad approximation.
|
||||
else if (mType == eCollideShapeType_Compound) {
|
||||
cVector3f vBoxSize = mBoundingVolume.GetSize();
|
||||
float fBoxVolume = vBoxSize.x * vBoxSize.y * vBoxSize.z;
|
||||
|
||||
float fInv = 1.0f / 12.0f;
|
||||
vInertia = cVector3f(
|
||||
afMass * (vBoxSize.y * vBoxSize.y + vBoxSize.z * vBoxSize.z) * fInv,
|
||||
afMass * (vBoxSize.x * vBoxSize.x + vBoxSize.z * vBoxSize.z) * fInv,
|
||||
afMass * (vBoxSize.x * vBoxSize.x + vBoxSize.y * vBoxSize.y) * fInv);
|
||||
// Scale of a bit of the inertia since the compound is not a 100% solid box
|
||||
vInertia = vInertia * (1.0f - ((fBoxVolume / mfVolume) * 0.3f));
|
||||
}
|
||||
|
||||
return vInertia;
|
||||
}
|
||||
|
||||
//-----------------------------------------------------------------------
|
||||
|
||||
void cCollideShapeNewton::CreateFromShapeVec(tCollideShapeVec &avShapes) {
|
||||
Common::Array<NewtonCollision *> vNewtonColliders;
|
||||
|
||||
vNewtonColliders.reserve(avShapes.size());
|
||||
mvSubShapes.reserve(avShapes.size());
|
||||
|
||||
mfVolume = 0;
|
||||
|
||||
for (size_t i = 0; i < avShapes.size(); i++) {
|
||||
mvSubShapes.push_back(avShapes[i]);
|
||||
|
||||
cCollideShapeNewton *pNewtonShape = static_cast<cCollideShapeNewton *>(avShapes[i]);
|
||||
vNewtonColliders.push_back(pNewtonShape->GetNewtonCollision());
|
||||
|
||||
mfVolume += pNewtonShape->GetVolume();
|
||||
}
|
||||
|
||||
mpNewtonCollision = NewtonCreateCompoundCollision(mpNewtonWorld, (int)vNewtonColliders.size(),
|
||||
&vNewtonColliders[0], 0);
|
||||
|
||||
// Create bounding volume
|
||||
cVector3f vFinalMax = avShapes[0]->GetBoundingVolume().GetMax();
|
||||
cVector3f vFinalMin = avShapes[0]->GetBoundingVolume().GetMin();
|
||||
|
||||
for (size_t i = 1; i < avShapes.size(); i++) {
|
||||
cVector3f vMax = avShapes[i]->GetBoundingVolume().GetMax();
|
||||
cVector3f vMin = avShapes[i]->GetBoundingVolume().GetMin();
|
||||
|
||||
if (vFinalMax.x < vMax.x)
|
||||
vFinalMax.x = vMax.x;
|
||||
if (vFinalMin.x > vMin.x)
|
||||
vFinalMin.x = vMin.x;
|
||||
|
||||
if (vFinalMax.y < vMax.y)
|
||||
vFinalMax.y = vMax.y;
|
||||
if (vFinalMin.y > vMin.y)
|
||||
vFinalMin.y = vMin.y;
|
||||
|
||||
if (vFinalMax.z < vMax.z)
|
||||
vFinalMax.z = vMax.z;
|
||||
if (vFinalMin.z > vMin.z)
|
||||
vFinalMin.z = vMin.z;
|
||||
}
|
||||
|
||||
mBoundingVolume.SetLocalMinMax(vFinalMin, vFinalMax);
|
||||
}
|
||||
|
||||
//-----------------------------------------------------------------------
|
||||
|
||||
void cCollideShapeNewton::CreateFromVertices(const unsigned int *apIndexArray, int alIndexNum,
|
||||
const float *apVertexArray, int alVtxStride, int alVtxNum) {
|
||||
float vTriVec[9];
|
||||
|
||||
mpNewtonCollision = NewtonCreateTreeCollision(mpNewtonWorld, 0);
|
||||
// Log("-- Creating mesh collision.:\n");
|
||||
NewtonTreeCollisionBeginBuild(mpNewtonCollision);
|
||||
for (int tri = 0; tri < alIndexNum; tri += 3) {
|
||||
// Log("tri: %d:\n", tri/3);
|
||||
for (int idx = 0; idx < 3; idx++) {
|
||||
int lVtx = apIndexArray[tri + 2 - idx] * alVtxStride;
|
||||
|
||||
vTriVec[idx * 3 + 0] = apVertexArray[lVtx + 0];
|
||||
vTriVec[idx * 3 + 1] = apVertexArray[lVtx + 1];
|
||||
vTriVec[idx * 3 + 2] = apVertexArray[lVtx + 2];
|
||||
}
|
||||
|
||||
NewtonTreeCollisionAddFace(mpNewtonCollision, 3, vTriVec, sizeof(float) * 3, 1);
|
||||
}
|
||||
|
||||
NewtonTreeCollisionEndBuild(mpNewtonCollision, false);
|
||||
|
||||
// Set bounding box size
|
||||
mBoundingVolume.AddArrayPoints(apVertexArray, alVtxNum);
|
||||
mBoundingVolume.CreateFromPoints(alVtxStride);
|
||||
}
|
||||
|
||||
//-----------------------------------------------------------------------
|
||||
|
||||
} // namespace hpl
|
||||
Reference in New Issue
Block a user