161 lines
6.5 KiB
C++
161 lines
6.5 KiB
C++
/* Copyright (c) <2003-2011> <Julio Jerez, Newton Game Dynamics>
|
|
*
|
|
* This software is provided 'as-is', without any express or implied
|
|
* warranty. In no event will the authors be held liable for any damages
|
|
* arising from the use of this software.
|
|
*
|
|
* Permission is granted to anyone to use this software for any purpose,
|
|
* including commercial applications, and to alter it and redistribute it
|
|
* freely, subject to the following restrictions:
|
|
*
|
|
* 1. The origin of this software must not be misrepresented; you must not
|
|
* claim that you wrote the original software. If you use this software
|
|
* in a product, an acknowledgment in the product documentation would be
|
|
* appreciated but is not required.
|
|
*
|
|
* 2. Altered source versions must be plainly marked as such, and must not be
|
|
* misrepresented as being the original software.
|
|
*
|
|
* 3. This notice may not be removed or altered from any source distribution.
|
|
*/
|
|
|
|
#if !defined(AFX_DGCOLLISIONCOMPOUND_H__E164CA46_D0ED_46EE_8130_46C4004940BA__INCLUDED_)
|
|
#define AFX_DGCOLLISIONCOMPOUND_H__E164CA46_D0ED_46EE_8130_46C4004940BA__INCLUDED_
|
|
|
|
#include "dgCollision.h"
|
|
#include "dgContact.h"
|
|
class dgCollisionConvex;
|
|
|
|
#define DG_COMPOUND_STACK_DEPTH 256
|
|
|
|
class dgCollisionCompound : public dgCollision {
|
|
protected:
|
|
enum dgNodeType {
|
|
m_leaf,
|
|
m_node,
|
|
};
|
|
|
|
class OOBBTestData {
|
|
public:
|
|
OOBBTestData(const dgMatrix &matrix);
|
|
OOBBTestData(const dgMatrix &matrix, const dgVector &p0, const dgVector &p1);
|
|
|
|
dgMatrix m_matrix;
|
|
dgMatrix m_absMatrix;
|
|
dgVector m_origin;
|
|
dgVector m_size;
|
|
dgVector m_localP0;
|
|
dgVector m_localP1;
|
|
dgVector m_aabbP0;
|
|
dgVector m_aabbP1;
|
|
dgVector m_crossAxis[3][3];
|
|
dgVector m_crossAxisAbs[3][3];
|
|
dgVector m_crossAxisDotAbs[3][3];
|
|
dgVector m_extends[3][3];
|
|
};
|
|
|
|
DG_MSC_VECTOR_ALIGMENT
|
|
class dgNodeBase {
|
|
public:
|
|
DG_CLASS_ALLOCATOR(allocator)
|
|
dgNodeBase();
|
|
dgNodeBase(dgCollisionConvex *const m_shape, dgInt32 id);
|
|
dgNodeBase(dgNodeBase *const left, dgNodeBase *const right, dgInt32 id);
|
|
~dgNodeBase();
|
|
void reset();
|
|
bool BoxTest(const OOBBTestData &data) const;
|
|
bool BoxTest(const OOBBTestData &data, const dgNodeBase *const otherNode) const;
|
|
|
|
dgFloat32 BoxClosestDistance(const dgVector *const points, dgInt32 count) const;
|
|
|
|
dgVector m_p0;
|
|
dgVector m_p1;
|
|
dgVector m_size;
|
|
dgVector m_origin;
|
|
dgInt32 m_type;
|
|
dgInt32 m_id;
|
|
dgFloat32 m_area;
|
|
dgNodeBase *m_left;
|
|
dgNodeBase *m_right;
|
|
dgNodeBase *m_parent;
|
|
dgCollisionConvex *m_shape;
|
|
} DG_GCC_VECTOR_ALIGMENT;
|
|
|
|
class dgHeapNodePair {
|
|
public:
|
|
dgInt32 m_nodeA;
|
|
dgInt32 m_nodeB;
|
|
};
|
|
|
|
public:
|
|
dgCollisionCompound(dgWorld *world);
|
|
dgCollisionCompound(const dgCollisionCompound &source);
|
|
dgCollisionCompound(dgInt32 count, dgCollisionConvex *const shapeArray[], dgWorld *world);
|
|
dgCollisionCompound(dgWorld *const world, dgDeserialize deserialization, void *const userData);
|
|
virtual ~dgCollisionCompound();
|
|
|
|
void AddCollision(dgCollisionConvex *part);
|
|
// void RemoveCollision (dgCollisionConvex* part);
|
|
void RemoveCollision(dgNodeBase *node);
|
|
|
|
protected:
|
|
void Init(dgInt32 count, dgCollisionConvex *const shapeArray[]);
|
|
virtual dgFloat32 GetVolume() const;
|
|
virtual dgFloat32 GetBoxMinRadius() const;
|
|
virtual dgFloat32 GetBoxMaxRadius() const;
|
|
|
|
virtual dgVector SupportVertex(const dgVector &dir) const;
|
|
virtual void CalcAABB(const dgMatrix &matrix, dgVector &p0, dgVector &p1) const;
|
|
virtual void CalcAABBSimd(const dgMatrix &matrix, dgVector &p0, dgVector &p1) const;
|
|
virtual bool OOBBTest(const dgMatrix &matrix, const dgCollisionConvex *const shape, void *const cacheOrder) const;
|
|
|
|
virtual void DebugCollision(const dgMatrix &matrix, OnDebugCollisionMeshCallback callback, void *const userData) const;
|
|
virtual void CalculateInertia(dgVector &inertia, dgVector &origin) const;
|
|
virtual dgVector CalculateVolumeIntegral(const dgMatrix &globalMatrix, GetBuoyancyPlane bouyancyPlane, void *const context) const;
|
|
virtual dgFloat32 RayCast(const dgVector &localP0, const dgVector &localP1, dgContactPoint &contactOut, OnRayPrecastAction preFilter, const dgBody *const body, void *const userData) const;
|
|
virtual dgFloat32 RayCastSimd(const dgVector &localP0, const dgVector &localP1, dgContactPoint &contactOut, OnRayPrecastAction preFilter, const dgBody *const body, void *const userData) const;
|
|
|
|
dgNodeBase *BuildTree(dgInt32 count, dgCollisionConvex *const shapeArray[]);
|
|
|
|
virtual dgInt32 CalculateSignature() const;
|
|
virtual void SetCollisionBBox(const dgVector &p0, const dgVector &p1);
|
|
virtual void GetCollisionInfo(dgCollisionInfo *info) const;
|
|
virtual void Serialize(dgSerialize callback, void *const userData) const;
|
|
void LinkParentNodes();
|
|
|
|
dgInt32 CalculateContacts(dgCollidingPairCollector::dgPair *const pair, dgCollisionParamProxy &proxy, dgInt32 useSimd) const;
|
|
dgInt32 CalculateContactsToSingle(dgCollidingPairCollector::dgPair *const pair, dgCollisionParamProxy &proxy, dgInt32 useSimd) const;
|
|
dgInt32 CalculateContactsToCompound(dgCollidingPairCollector::dgPair *const pair, dgCollisionParamProxy &proxy, dgInt32 useSimd) const;
|
|
dgInt32 CalculateContactsToCollisionTree(dgCollidingPairCollector::dgPair *const pair, dgCollisionParamProxy &proxy, dgInt32 useSimd) const;
|
|
dgInt32 CalculateContactsToHeightField(dgCollidingPairCollector::dgPair *const pair, dgCollisionParamProxy &proxy, dgInt32 useSimd) const;
|
|
dgInt32 CalculateContactsBruteForce(dgCollidingPairCollector::dgPair *const pair, dgCollisionParamProxy &proxy, dgInt32 useSimd) const;
|
|
|
|
dgInt32 ClosestDitance(dgBody *const bodyA, dgTriplex &contactA, dgBody *const bodyB, dgTriplex &contactB, dgTriplex &normalAB) const;
|
|
|
|
#ifdef _DEBUG
|
|
dgVector IntenalSupportVertex(const dgVector &dir) const;
|
|
#endif
|
|
|
|
protected:
|
|
// dgInt32 GetAxis (dgNodeBase** const proxiArray, dgInt32 boxCount) const;
|
|
// static dgInt32 CompareBox (const dgNodeBase* const boxA, const dgNodeBase* const boxB, void* const context);
|
|
// dgNodeBase* BuildBottomUpTree(dgInt32 count, dgNodeBase** const proxiArray);
|
|
|
|
void ImproveNodeFitness(dgNodeBase *const node) const;
|
|
dgNodeBase *BuildTopDownTree(dgInt32 count, dgNodeBase **const proxiArray, dgInt32 &id);
|
|
void PushNodes(dgNodeBase *const root, dgNodeBase **const proxiArray, dgInt32 &index) const;
|
|
dgFloat32 CalculateSurfaceArea(dgNodeBase *const node0, dgNodeBase *const node1, dgVector &minBox, dgVector &maxBox) const;
|
|
|
|
dgInt32 m_count;
|
|
dgFloat32 m_boxMinRadius;
|
|
dgFloat32 m_boxMaxRadius;
|
|
dgWorld *m_world;
|
|
dgNodeBase *m_root;
|
|
dgCollisionConvex **m_array;
|
|
OnCompoundCollisionPrefilter *m_preCollisionFilter;
|
|
friend class dgBody;
|
|
friend class dgWorld;
|
|
};
|
|
|
|
#endif
|