284 lines
9.1 KiB
C
284 lines
9.1 KiB
C
|
//
|
||
|
|
// Redistribution and use in source and binary forms, with or without
|
||
|
|
// modification, are permitted provided that the following conditions
|
||
|
|
// are met:
|
||
|
|
// * Redistributions of source code must retain the above copyright
|
||
|
|
// notice, this list of conditions and the following disclaimer.
|
||
|
|
// * Redistributions in binary form must reproduce the above copyright
|
||
|
|
// notice, this list of conditions and the following disclaimer in the
|
||
|
|
// documentation and/or other materials provided with the distribution.
|
||
|
|
// * Neither the name of NVIDIA CORPORATION nor the names of its
|
||
|
|
// contributors may be used to endorse or promote products derived
|
||
|
|
// from this software without specific prior written permission.
|
||
|
|
//
|
||
|
|
// THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS ``AS IS'' AND ANY
|
||
|
|
// EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
|
||
|
|
// IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
|
||
|
|
// PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR
|
||
|
|
// CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
|
||
|
|
// EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
|
||
|
|
// PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR
|
||
|
|
// PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY
|
||
|
|
// OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
|
||
|
|
// (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
|
||
|
|
// OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
||
|
|
//
|
||
|
|
// Copyright (c) 2008-2019 NVIDIA Corporation. All rights reserved.
|
||
|
|
// Copyright (c) 2004-2008 AGEIA Technologies, Inc. All rights reserved.
|
||
|
|
// Copyright (c) 2001-2004 NovodeX AG. All rights reserved.
|
||
|
|
|
||
|
|
#ifndef GU_BV4_H
|
||
|
|
#define GU_BV4_H
|
||
|
|
|
||
|
|
#include "foundation/PxBounds3.h"
|
||
|
|
#include "common/PxSerialFramework.h"
|
||
|
|
#include "PsUserAllocated.h"
|
||
|
|
#include "GuBV4Settings.h"
|
||
|
|
#include "GuCenterExtents.h"
|
||
|
|
|
||
|
|
#define V4LoadU_Safe V4LoadU
|
||
|
|
#define V4LoadA_Safe V4LoadA
|
||
|
|
#define V4StoreA_Safe V4StoreA
|
||
|
|
#define V4StoreU_Safe V4StoreU
|
||
|
|
|
||
|
|
namespace physx
|
||
|
|
{
|
||
|
|
namespace Gu
|
||
|
|
{
|
||
|
|
|
||
|
|
struct VertexPointers
|
||
|
|
{
|
||
|
|
const PxVec3* Vertex[3];
|
||
|
|
};
|
||
|
|
|
||
|
|
class IndTri32 : public physx::shdfnd::UserAllocated
|
||
|
|
{
|
||
|
|
public:
|
||
|
|
PX_FORCE_INLINE IndTri32() {}
|
||
|
|
PX_FORCE_INLINE IndTri32(PxU32 r0, PxU32 r1, PxU32 r2) { mRef[0]=r0; mRef[1]=r1; mRef[2]=r2; }
|
||
|
|
PX_FORCE_INLINE IndTri32(const IndTri32& triangle)
|
||
|
|
{
|
||
|
|
mRef[0] = triangle.mRef[0];
|
||
|
|
mRef[1] = triangle.mRef[1];
|
||
|
|
mRef[2] = triangle.mRef[2];
|
||
|
|
}
|
||
|
|
PX_FORCE_INLINE ~IndTri32() {}
|
||
|
|
PxU32 mRef[3];
|
||
|
|
};
|
||
|
|
PX_COMPILE_TIME_ASSERT(sizeof(IndTri32)==12);
|
||
|
|
|
||
|
|
class IndTri16 : public physx::shdfnd::UserAllocated
|
||
|
|
{
|
||
|
|
public:
|
||
|
|
PX_FORCE_INLINE IndTri16() {}
|
||
|
|
PX_FORCE_INLINE IndTri16(PxU16 r0, PxU16 r1, PxU16 r2) { mRef[0]=r0; mRef[1]=r1; mRef[2]=r2; }
|
||
|
|
PX_FORCE_INLINE IndTri16(const IndTri16& triangle)
|
||
|
|
{
|
||
|
|
mRef[0] = triangle.mRef[0];
|
||
|
|
mRef[1] = triangle.mRef[1];
|
||
|
|
mRef[2] = triangle.mRef[2];
|
||
|
|
}
|
||
|
|
PX_FORCE_INLINE ~IndTri16() {}
|
||
|
|
PxU16 mRef[3];
|
||
|
|
};
|
||
|
|
PX_COMPILE_TIME_ASSERT(sizeof(IndTri16)==6);
|
||
|
|
|
||
|
|
PX_FORCE_INLINE void getVertexReferences(PxU32& vref0, PxU32& vref1, PxU32& vref2, PxU32 index, const IndTri32* T32, const IndTri16* T16)
|
||
|
|
{
|
||
|
|
if(T32)
|
||
|
|
{
|
||
|
|
const IndTri32* PX_RESTRICT tri = T32 + index;
|
||
|
|
vref0 = tri->mRef[0];
|
||
|
|
vref1 = tri->mRef[1];
|
||
|
|
vref2 = tri->mRef[2];
|
||
|
|
}
|
||
|
|
else
|
||
|
|
{
|
||
|
|
const IndTri16* PX_RESTRICT tri = T16 + index;
|
||
|
|
vref0 = tri->mRef[0];
|
||
|
|
vref1 = tri->mRef[1];
|
||
|
|
vref2 = tri->mRef[2];
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
|
||
|
|
class SourceMeshBase : public physx::shdfnd::UserAllocated
|
||
|
|
{
|
||
|
|
public:
|
||
|
|
PX_PHYSX_COMMON_API SourceMeshBase();
|
||
|
|
PX_PHYSX_COMMON_API ~SourceMeshBase();
|
||
|
|
|
||
|
|
SourceMeshBase(const PxEMPTY) {}
|
||
|
|
|
||
|
|
PxU32 mNbVerts;
|
||
|
|
const PxVec3* mVerts;
|
||
|
|
|
||
|
|
PX_FORCE_INLINE PxU32 getNbVertices() const { return mNbVerts; }
|
||
|
|
PX_FORCE_INLINE const PxVec3* getVerts() const { return mVerts; }
|
||
|
|
|
||
|
|
PX_FORCE_INLINE void setNbVertices(PxU32 nb) { mNbVerts = nb; }
|
||
|
|
|
||
|
|
PX_FORCE_INLINE void initRemap() { mRemap = NULL; }
|
||
|
|
PX_FORCE_INLINE const PxU32* getRemap() const { return mRemap; }
|
||
|
|
PX_FORCE_INLINE void releaseRemap() { PX_FREE_AND_RESET(mRemap); }
|
||
|
|
|
||
|
|
protected:
|
||
|
|
PxU32* mRemap;
|
||
|
|
|
||
|
|
};
|
||
|
|
|
||
|
|
class SourceMesh : public SourceMeshBase
|
||
|
|
{
|
||
|
|
public:
|
||
|
|
PX_PHYSX_COMMON_API SourceMesh();
|
||
|
|
PX_PHYSX_COMMON_API ~SourceMesh();
|
||
|
|
// PX_SERIALIZATION
|
||
|
|
SourceMesh(const PxEMPTY) {}
|
||
|
|
static void getBinaryMetaData(PxOutputStream& stream);
|
||
|
|
//~PX_SERIALIZATION
|
||
|
|
|
||
|
|
void reset();
|
||
|
|
void operator = (SourceMesh& v);
|
||
|
|
|
||
|
|
PxU32 mNbTris;
|
||
|
|
IndTri32* mTriangles32;
|
||
|
|
IndTri16* mTriangles16;
|
||
|
|
|
||
|
|
PX_FORCE_INLINE PxU32 getNbTriangles() const { return mNbTris; }
|
||
|
|
//PX_FORCE_INLINE PxU32 getNbVertices() const { return mNbVerts; }
|
||
|
|
PX_FORCE_INLINE const IndTri32* getTris32() const { return mTriangles32; }
|
||
|
|
PX_FORCE_INLINE const IndTri16* getTris16() const { return mTriangles16; }
|
||
|
|
//PX_FORCE_INLINE const PxVec3* getVerts() const { return mVerts; }
|
||
|
|
|
||
|
|
PX_FORCE_INLINE void setNbTriangles(PxU32 nb) { mNbTris = nb; }
|
||
|
|
//PX_FORCE_INLINE void setNbVertices(PxU32 nb) { mNbVerts = nb; }
|
||
|
|
|
||
|
|
PX_FORCE_INLINE void setPointers(IndTri32* tris32, IndTri16* tris16, const PxVec3* verts)
|
||
|
|
{
|
||
|
|
mTriangles32 = tris32;
|
||
|
|
mTriangles16 = tris16;
|
||
|
|
mVerts = verts;
|
||
|
|
}
|
||
|
|
|
||
|
|
void remapTopology(const PxU32* order);
|
||
|
|
|
||
|
|
bool isValid() const;
|
||
|
|
|
||
|
|
PX_FORCE_INLINE void getTriangle(VertexPointers& vp, PxU32 index) const
|
||
|
|
{
|
||
|
|
PxU32 VRef0, VRef1, VRef2;
|
||
|
|
getVertexReferences(VRef0, VRef1, VRef2, index, mTriangles32, mTriangles16);
|
||
|
|
vp.Vertex[0] = mVerts + VRef0;
|
||
|
|
vp.Vertex[1] = mVerts + VRef1;
|
||
|
|
vp.Vertex[2] = mVerts + VRef2;
|
||
|
|
}
|
||
|
|
|
||
|
|
};
|
||
|
|
|
||
|
|
struct LocalBounds
|
||
|
|
{
|
||
|
|
// PX_SERIALIZATION
|
||
|
|
LocalBounds(const PxEMPTY) {}
|
||
|
|
//~PX_SERIALIZATION
|
||
|
|
LocalBounds() : mCenter(PxVec3(0.0f)), mExtentsMagnitude(0.0f) {}
|
||
|
|
|
||
|
|
PxVec3 mCenter;
|
||
|
|
float mExtentsMagnitude;
|
||
|
|
|
||
|
|
PX_FORCE_INLINE void init(const PxBounds3& bounds)
|
||
|
|
{
|
||
|
|
mCenter = bounds.getCenter();
|
||
|
|
// PT: TODO: compute mag first, then multiplies by 0.5f (TA34704)
|
||
|
|
mExtentsMagnitude = bounds.getExtents().magnitude();
|
||
|
|
}
|
||
|
|
};
|
||
|
|
|
||
|
|
class QuantizedAABB
|
||
|
|
{
|
||
|
|
public:
|
||
|
|
|
||
|
|
struct Data
|
||
|
|
{
|
||
|
|
PxU16 mExtents; //!< Quantized extents
|
||
|
|
PxI16 mCenter; //!< Quantized center
|
||
|
|
};
|
||
|
|
Data mData[3];
|
||
|
|
};
|
||
|
|
PX_COMPILE_TIME_ASSERT(sizeof(QuantizedAABB)==12);
|
||
|
|
|
||
|
|
/////
|
||
|
|
|
||
|
|
#define GU_BV4_CHILD_OFFSET_SHIFT_COUNT 11
|
||
|
|
static PX_FORCE_INLINE PxU32 getChildOffset(PxU32 data) { return data>>GU_BV4_CHILD_OFFSET_SHIFT_COUNT; }
|
||
|
|
static PX_FORCE_INLINE PxU32 getChildType(PxU32 data) { return (data>>1)&3; }
|
||
|
|
|
||
|
|
template<class BoxType>
|
||
|
|
struct BVDataPackedT : public physx::shdfnd::UserAllocated
|
||
|
|
{
|
||
|
|
BoxType mAABB;
|
||
|
|
PxU32 mData;
|
||
|
|
|
||
|
|
PX_FORCE_INLINE PxU32 isLeaf() const { return mData&1; }
|
||
|
|
PX_FORCE_INLINE PxU32 getPrimitive() const { return mData>>1; }
|
||
|
|
PX_FORCE_INLINE PxU32 getChildOffset() const { return mData>>GU_BV4_CHILD_OFFSET_SHIFT_COUNT;}
|
||
|
|
PX_FORCE_INLINE PxU32 getChildType() const { return (mData>>1)&3; }
|
||
|
|
PX_FORCE_INLINE PxU32 getChildData() const { return mData; }
|
||
|
|
|
||
|
|
PX_FORCE_INLINE void encodePNS(PxU32 code)
|
||
|
|
{
|
||
|
|
PX_ASSERT(code<256);
|
||
|
|
mData |= code<<3;
|
||
|
|
}
|
||
|
|
PX_FORCE_INLINE PxU32 decodePNSNoShift() const { return mData; }
|
||
|
|
};
|
||
|
|
|
||
|
|
typedef BVDataPackedT<QuantizedAABB> BVDataPackedQ;
|
||
|
|
#ifdef GU_BV4_COMPILE_NON_QUANTIZED_TREE
|
||
|
|
typedef BVDataPackedT<CenterExtents> BVDataPackedNQ;
|
||
|
|
#endif
|
||
|
|
|
||
|
|
// PT: TODO: align class to 16? (TA34704)
|
||
|
|
class BV4Tree : public physx::shdfnd::UserAllocated
|
||
|
|
{
|
||
|
|
public:
|
||
|
|
// PX_SERIALIZATION
|
||
|
|
BV4Tree(const PxEMPTY);
|
||
|
|
void exportExtraData(PxSerializationContext&);
|
||
|
|
void importExtraData(PxDeserializationContext& context);
|
||
|
|
static void getBinaryMetaData(PxOutputStream& stream);
|
||
|
|
//~PX_SERIALIZATION
|
||
|
|
|
||
|
|
PX_PHYSX_COMMON_API BV4Tree();
|
||
|
|
PX_PHYSX_COMMON_API BV4Tree(SourceMesh* meshInterface, const PxBounds3& localBounds);
|
||
|
|
PX_PHYSX_COMMON_API ~BV4Tree();
|
||
|
|
|
||
|
|
bool load(PxInputStream& stream, bool mismatch);
|
||
|
|
|
||
|
|
void reset();
|
||
|
|
void operator = (BV4Tree& v);
|
||
|
|
|
||
|
|
bool init(SourceMesh* meshInterface, const PxBounds3& localBounds);
|
||
|
|
void release();
|
||
|
|
|
||
|
|
void refit(float epsilon);
|
||
|
|
|
||
|
|
// PT: TODO: use a single pointer to SourceMeshBase
|
||
|
|
SourceMesh* mMeshInterface;
|
||
|
|
LocalBounds mLocalBounds;
|
||
|
|
|
||
|
|
PxU32 mNbNodes;
|
||
|
|
void* mNodes; // PT: BVDataPacked / BVDataSwizzled
|
||
|
|
PxU32 mInitData;
|
||
|
|
// PT: the dequantization coeffs are only used for quantized trees
|
||
|
|
PxVec3 mCenterOrMinCoeff; // PT: dequantization coeff, either for Center or Min (depending on AABB format)
|
||
|
|
PxVec3 mExtentsOrMaxCoeff; // PT: dequantization coeff, either for Extents or Max (depending on AABB format)
|
||
|
|
bool mUserAllocated; // PT: please keep these 4 bytes right after mCenterOrMinCoeff/mExtentsOrMaxCoeff for safe V4 loading
|
||
|
|
bool mQuantized; // PT: true for quantized trees
|
||
|
|
bool mPadding[2];
|
||
|
|
};
|
||
|
|
|
||
|
|
} // namespace Gu
|
||
|
|
}
|
||
|
|
|
||
|
|
#endif // GU_BV4_H
|