feat(physics): wire physx sdk into build

engine/third_party/physx/source/lowlevel/common/include/collision/PxcContactMethodImpl.h

@@ -0,0 +1,50 @@
+// 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-2025 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 PXC_CONTACT_METHOD_IMPL_H
+#define PXC_CONTACT_METHOD_IMPL_H
+
+#include "GuContactMethodImpl.h"
+
+namespace physx
+{
+
+/*!
+Method prototype for contact generation routines
+*/
+typedef bool (*PxcContactMethod) (GU_CONTACT_METHOD_ARGS);
+
+// Matrix of types
+extern PxcContactMethod g_ContactMethodTable[][PxGeometryType::eGEOMETRY_COUNT];
+extern const bool g_CanUseContactCache[][PxGeometryType::eGEOMETRY_COUNT];
+extern PxcContactMethod g_PCMContactMethodTable[][PxGeometryType::eGEOMETRY_COUNT];
+
+extern const bool gEnablePCMCaching[][PxGeometryType::eGEOMETRY_COUNT];
+}
+
+#endif

engine/third_party/physx/source/lowlevel/common/include/pipeline/PxcConstraintBlockStream.h

@@ -0,0 +1,154 @@
+// 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-2025 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 PXC_CONSTRAINT_BLOCK_POOL_H
+#define PXC_CONSTRAINT_BLOCK_POOL_H
+
+#include "PxvConfig.h"
+#include "foundation/PxArray.h"
+#include "foundation/PxMutex.h"
+#include "PxcNpMemBlockPool.h"
+
+namespace physx
+{
+class PxsConstraintBlockManager
+{
+public:
+	PxsConstraintBlockManager(PxcNpMemBlockPool & blockPool):
+		mBlockPool(blockPool)
+	{
+	}
+
+	PX_FORCE_INLINE	void reset()
+	{
+		mBlockPool.releaseConstraintBlocks(mTrackingArray);
+	}
+
+	PxcNpMemBlockArray	mTrackingArray;
+	PxcNpMemBlockPool&	mBlockPool;
+
+private:
+	PxsConstraintBlockManager& operator=(const PxsConstraintBlockManager&);
+};
+
+class PxcConstraintBlockStream
+{
+	PX_NOCOPY(PxcConstraintBlockStream)
+public:
+	PxcConstraintBlockStream(PxcNpMemBlockPool & blockPool) :
+		mBlockPool	(blockPool),
+		mBlock		(NULL),
+		mUsed		(0)
+	{
+	}
+
+	PX_FORCE_INLINE	PxU8*				reserve(PxU32 size, PxsConstraintBlockManager& manager)
+										{
+											size = (size+15)&~15;
+											if(size>PxcNpMemBlock::SIZE)
+												return mBlockPool.acquireExceptionalConstraintMemory(size);
+
+											if(mBlock == NULL || size+mUsed>PxcNpMemBlock::SIZE)
+											{
+												mBlock = mBlockPool.acquireConstraintBlock(manager.mTrackingArray);
+												PX_ASSERT(0==mBlock || mBlock->data == reinterpret_cast<PxU8*>(mBlock));
+												mUsed = size;
+												return reinterpret_cast<PxU8*>(mBlock);
+											}
+											PX_ASSERT(mBlock && mBlock->data == reinterpret_cast<PxU8*>(mBlock));
+											PxU8* PX_RESTRICT result = mBlock->data+mUsed;
+											mUsed += size;
+											return result;
+										}
+
+	PX_FORCE_INLINE	void				reset()
+										{
+											mBlock = NULL;
+											mUsed = 0;
+										}
+
+	PX_FORCE_INLINE PxcNpMemBlockPool&	getMemBlockPool()	{ return mBlockPool;	}
+
+private:
+			PxcNpMemBlockPool&			mBlockPool;
+			PxcNpMemBlock*				mBlock;	// current constraint block
+			PxU32						mUsed;	// number of bytes used in constraint block
+			//Tracking peak allocations
+			PxU32						mPeakUsed;
+};
+
+class PxcContactBlockStream
+{
+	PX_NOCOPY(PxcContactBlockStream)
+public:
+	PxcContactBlockStream(PxcNpMemBlockPool & blockPool):
+		mBlockPool(blockPool),
+		mBlock(NULL),
+		mUsed(0)
+	{
+	}
+
+	PX_FORCE_INLINE	PxU8*				reserve(PxU32 size)
+										{
+											size = (size+15)&~15;
+
+											if(size>PxcNpMemBlock::SIZE)
+												return mBlockPool.acquireExceptionalConstraintMemory(size);
+
+											PX_ASSERT(size <= PxcNpMemBlock::SIZE);
+
+											if(mBlock == NULL || size+mUsed>PxcNpMemBlock::SIZE)
+											{
+												mBlock = mBlockPool.acquireContactBlock();
+												PX_ASSERT(0==mBlock || mBlock->data == reinterpret_cast<PxU8*>(mBlock));
+												mUsed = size;
+												return reinterpret_cast<PxU8*>(mBlock);
+											}
+											PX_ASSERT(mBlock && mBlock->data == reinterpret_cast<PxU8*>(mBlock));
+											PxU8* PX_RESTRICT result = mBlock->data+mUsed;
+											mUsed += size;
+											return result;
+										}
+
+	PX_FORCE_INLINE	void				reset()
+										{
+											mBlock = NULL;
+											mUsed = 0;
+										}
+
+	PX_FORCE_INLINE PxcNpMemBlockPool&	getMemBlockPool()	{ return mBlockPool;	}
+
+private:
+			PxcNpMemBlockPool&			mBlockPool;
+			PxcNpMemBlock*				mBlock;	// current constraint block
+			PxU32						mUsed;	// number of bytes used in constraint block
+};
+
+}
+
+#endif

engine/third_party/physx/source/lowlevel/common/include/pipeline/PxcContactCache.h

@@ -0,0 +1,65 @@
+// 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-2025 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 PXC_CONTACT_CACHE_H
+#define PXC_CONTACT_CACHE_H
+
+#include "foundation/PxTransform.h"
+#include "PxvConfig.h"
+#include "PxcContactMethodImpl.h"
+
+namespace physx
+{
+	class PxcNpThreadContext;
+
+	bool PxcCacheLocalContacts(	PxcNpThreadContext& context, Gu::Cache& pairContactCache,
+								const PxTransform32& tm0, const PxTransform32& tm1,
+								const PxcContactMethod conMethod,
+								const PxGeometry& shape0, const PxGeometry& shape1);
+
+	struct PxcLocalContactsCache
+	{
+		PxTransform	mTransform0;
+		PxTransform	mTransform1;
+		PxU16		mNbCachedContacts;
+		bool		mUseFaceIndices;
+		bool		mSameNormal;
+
+		PX_FORCE_INLINE void operator = (const PxcLocalContactsCache& other)
+		{
+			mTransform0			= other.mTransform0;
+			mTransform1			= other.mTransform1;
+			mNbCachedContacts	= other.mNbCachedContacts;
+			mUseFaceIndices		= other.mUseFaceIndices;
+			mSameNormal			= other.mSameNormal;
+		}
+	};
+
+}
+
+#endif  // PXC_CONTACT_CACHE_H

engine/third_party/physx/source/lowlevel/common/include/pipeline/PxcMaterialMethodImpl.h

@@ -0,0 +1,65 @@
+// 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-2025 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 PXC_MATERIAL_METHOD_H
+#define PXC_MATERIAL_METHOD_H
+
+#include "geometry/PxGeometry.h"
+
+namespace physx
+{
+struct PxsShapeCore;
+struct PxsMaterialInfo;
+class PxContactBuffer;
+
+#define MATERIAL_METHOD_ARGS				\
+	const PxsShapeCore* shape0,				\
+	const PxsShapeCore* shape1,				\
+	const PxContactBuffer& contactBuffer,	\
+	PxsMaterialInfo* materialInfo
+
+#define SINGLE_MATERIAL_METHOD_ARGS			\
+	const PxsShapeCore* shape,				\
+	PxU32 index,							\
+	const PxContactBuffer& contactBuffer,	\
+	PxsMaterialInfo* materialInfo
+
+/*!
+Method prototype for fetch material routines
+*/
+typedef void (*PxcGetMaterialMethod) (MATERIAL_METHOD_ARGS);
+
+typedef void (*PxcGetSingleMaterialMethod) (SINGLE_MATERIAL_METHOD_ARGS);
+
+extern PxcGetMaterialMethod g_GetMaterialMethodTable[][PxGeometryType::eGEOMETRY_COUNT];
+
+extern PxcGetSingleMaterialMethod g_GetSingleMaterialMethodTable[PxGeometryType::eGEOMETRY_COUNT];
+
+}
+
+#endif

engine/third_party/physx/source/lowlevel/common/include/pipeline/PxcNpBatch.h

@@ -0,0 +1,49 @@
+// 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-2025 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 PXC_NP_BATCH_H
+#define PXC_NP_BATCH_H
+
+#include "PxvConfig.h"
+
+namespace physx
+{
+	struct PxcNpWorkUnit;
+	class PxcNpThreadContext;
+	struct PxsContactManagerOutput;
+
+	namespace Gu
+	{
+		struct Cache;
+	}
+
+	void PxcDiscreteNarrowPhase(PxcNpThreadContext& context, const PxcNpWorkUnit& cmInput, Gu::Cache& cache, PxsContactManagerOutput& output, PxU64 contextID);
+	void PxcDiscreteNarrowPhasePCM(PxcNpThreadContext& context, const PxcNpWorkUnit& cmInput, Gu::Cache& cache, PxsContactManagerOutput& output, PxU64 contextID);
+}
+
+#endif

engine/third_party/physx/source/lowlevel/common/include/pipeline/PxcNpCache.h

@@ -0,0 +1,132 @@
+// 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-2025 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 PXC_NP_CACHE_H
+#define PXC_NP_CACHE_H
+
+#include "foundation/PxMemory.h"
+#include "foundation/PxIntrinsics.h"
+#include "foundation/PxPool.h"
+#include "foundation/PxPreprocessor.h"
+#include "foundation/PxUtilities.h"
+
+#include "PxcNpCacheStreamPair.h"
+
+#include "GuContactMethodImpl.h"
+
+namespace physx
+{
+
+PX_FORCE_INLINE void PxcNpCacheReserve(PxcNpCacheStreamPair& streams, Gu::Cache& cache, PxU32 bytes)
+{
+	bool sizeTooLarge;
+	PxU8* ls = streams.reserve(bytes, sizeTooLarge);
+	cache.mCachedData = ls;
+	
+	if(sizeTooLarge)
+	{
+		// PT: TODO: consider changing the error message, it will silently become obsolete if we change the value of PxcNpMemBlock::SIZE.
+		// On the other hand the PxSceneDesc::maxNbContactDataBlocks also hardcodes "16K data blocks" so this isn't urgent.
+		PX_WARN_ONCE(
+			"Attempting to allocate more than 16K of contact data for a single contact pair in narrowphase. "
+			"Either accept dropped contacts or simplify collision geometry.");
+	}
+	else if(ls==NULL)
+	{
+		PX_WARN_ONCE(
+			"Reached limit set by PxSceneDesc::maxNbContactDataBlocks - ran out of buffer space for narrow phase. "
+			"Either accept dropped contacts or increase buffer size allocated for narrow phase by increasing PxSceneDesc::maxNbContactDataBlocks.");
+	}
+}
+
+template <typename T>
+void PxcNpCacheWrite(PxcNpCacheStreamPair& streams,
+					 Gu::Cache& cache,
+					 const T& payload,
+					 PxU32 bytes, 
+					 const PxU8* data)
+{
+	PxU8* ls = PxcNpCacheWriteInitiate(streams, cache, payload, bytes);
+
+	if (ls == NULL)
+		return;
+
+	PxcNpCacheWriteFinalize(ls, payload, bytes, data);
+}
+
+
+template <typename T>
+PxU8* PxcNpCacheWriteInitiate(PxcNpCacheStreamPair& streams, Gu::Cache& cache, const T& payload, PxU32 bytes)
+{
+	const PxU32 payloadSize = (sizeof(payload)+3)&~3;
+	cache.mCachedSize = PxTo16((payloadSize + 4 + bytes + 0xF)&~0xF);
+
+	PxcNpCacheReserve(streams, cache, cache.mCachedSize);
+
+	return cache.mCachedData;
+}
+
+template <typename T>
+PX_FORCE_INLINE void PxcNpCacheWriteFinalize(PxU8* ls, const T& payload, PxU32 bytes, const PxU8* data)
+{
+	const PxU32 payloadSize = (sizeof(payload)+3)&~3;
+	*reinterpret_cast<T*>(ls) = payload;
+	*reinterpret_cast<PxU32*>(ls+payloadSize) = bytes;
+	if(data)
+		PxMemCopy(ls+payloadSize+sizeof(PxU32), data, bytes);
+}
+
+template <typename T>
+PX_FORCE_INLINE PxU8* PxcNpCacheRead(Gu::Cache& cache, T*& payload)
+{
+	PxU8* ls = cache.mCachedData;
+	payload = reinterpret_cast<T*>(ls);
+	const PxU32 payloadSize = (sizeof(T)+3)&~3;
+	return reinterpret_cast<PxU8*>(ls+payloadSize+sizeof(PxU32));
+}
+
+template <typename T>
+const PxU8* PxcNpCacheRead2(Gu::Cache& cache, T& payload, PxU32& bytes)
+{
+	const PxU8* ls = cache.mCachedData;
+	if(ls==NULL)
+	{
+		bytes = 0;
+		return NULL;
+	}
+
+	const PxU32 payloadSize = (sizeof(payload)+3)&~3;
+	payload = *reinterpret_cast<const T*>(ls);
+	bytes = *reinterpret_cast<const PxU32*>(ls+payloadSize);
+	PX_ASSERT(cache.mCachedSize == ((payloadSize + 4 + bytes+0xF)&~0xF));
+	return reinterpret_cast<const PxU8*>(ls+payloadSize+sizeof(PxU32));
+}
+
+}
+
+#endif

engine/third_party/physx/source/lowlevel/common/include/pipeline/PxcNpCacheStreamPair.h

@@ -0,0 +1,58 @@
+// 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-2025 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 PXC_NP_CACHE_STREAM_PAIR_H
+#define PXC_NP_CACHE_STREAM_PAIR_H
+
+#include "foundation/PxSimpleTypes.h"
+#include "PxvConfig.h"
+#include "PxcNpMemBlockPool.h"
+
+namespace physx
+{
+	struct PxcNpCacheStreamPair
+	{
+										PX_NOCOPY(PxcNpCacheStreamPair)
+	public:
+										PxcNpCacheStreamPair(PxcNpMemBlockPool& blockPool);
+
+					// reserve can fail and return null.
+					PxU8*				reserve(PxU32 byteCount, bool& sizeTooLarge);
+	PX_FORCE_INLINE	void				reset()
+										{
+											mBlock = NULL;
+											mUsed = 0;
+										}
+	private:
+					PxcNpMemBlockPool&	mBlockPool;
+					PxcNpMemBlock*		mBlock;
+					PxU32				mUsed;
+	};
+}
+
+#endif

engine/third_party/physx/source/lowlevel/common/include/pipeline/PxcNpContactPrepShared.h

@@ -0,0 +1,60 @@
+// 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-2025 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 PXC_NP_CONTACT_PREP_SHARED_H
+#define PXC_NP_CONTACT_PREP_SHARED_H
+
+#include "foundation/PxSimpleTypes.h"
+
+namespace physx
+{
+class PxcNpThreadContext;
+struct PxsMaterialInfo;
+class PxsMaterialManager;
+class PxsConstraintBlockManager;
+class PxcConstraintBlockStream;
+struct PxContactPoint;
+struct PxcDataStreamPool;
+
+PX_FORCE_INLINE PxU32 computeAlignedSize(PxU32 size)
+{
+	return (size + 0xf) & 0xfffffff0;
+}
+
+static const PxReal PXC_SAME_NORMAL = 0.999f; //Around 6 degrees
+
+PxU32 writeCompressedContact(const PxContactPoint* const PX_RESTRICT contactPoints, const PxU32 numContactPoints, PxcNpThreadContext* threadContext,
+								PxU16& writtenContactCount, PxU8*& outContactPatches, PxU8*& outContactPoints, PxU16& compressedContactSize, PxReal*& contactForces, PxU32 contactForceByteSize,
+								PxU8*& outFrictionPatches, PxcDataStreamPool* frictionPatchesStreamPool,
+								const PxsMaterialManager* materialManager, bool hasModifiableContacts, bool forceNoResponse, const PxsMaterialInfo* PX_RESTRICT pMaterial, PxU8& numPatches,
+								PxU32 additionalHeaderSize = 0, PxsConstraintBlockManager* manager = NULL, PxcConstraintBlockStream* blockStream = NULL, bool insertAveragePoint = false,
+								PxcDataStreamPool* pool = NULL, PxcDataStreamPool* patchStreamPool = NULL, PxcDataStreamPool* forcePool = NULL, const bool isMeshType = false);
+
+}
+
+#endif

engine/third_party/physx/source/lowlevel/common/include/pipeline/PxcNpMemBlockPool.h

@@ -0,0 +1,117 @@
+// 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-2025 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 PXC_NP_MEM_BLOCK_POOL_H
+#define PXC_NP_MEM_BLOCK_POOL_H
+
+#include "PxvConfig.h"
+#include "foundation/PxArray.h"
+#include "foundation/PxMutex.h"
+
+namespace physx
+{
+class PxcScratchAllocator;
+
+struct PxcNpMemBlock
+{
+	enum
+	{
+		SIZE = 16384
+	};
+	PxU8 data[SIZE];
+};
+
+typedef PxArray<PxcNpMemBlock*> PxcNpMemBlockArray;
+
+class PxcNpMemBlockPool
+{
+	PX_NOCOPY(PxcNpMemBlockPool)
+public:
+	PxcNpMemBlockPool(PxcScratchAllocator& allocator);
+	~PxcNpMemBlockPool();
+
+	void			init(PxU32 initial16KDataBlocks, PxU32 maxBlocks);
+	void			flush();
+	void			setBlockCount(PxU32 count);
+	PxU32			getUsedBlockCount() const;
+	PxU32			getMaxUsedBlockCount() const;
+	PxU32			getPeakConstraintBlockCount() const;
+	void			releaseUnusedBlocks();
+
+	PxcNpMemBlock*	acquireConstraintBlock();
+	PxcNpMemBlock*	acquireConstraintBlock(PxcNpMemBlockArray& memBlocks);
+	PxcNpMemBlock*	acquireContactBlock();
+	PxcNpMemBlock*	acquireFrictionBlock();
+	PxcNpMemBlock*	acquireNpCacheBlock();
+
+	PxU8*			acquireExceptionalConstraintMemory(PxU32 size);
+
+	void			acquireConstraintMemory();
+	void			releaseConstraintMemory();
+	void			releaseConstraintBlocks(PxcNpMemBlockArray& memBlocks);
+	void			releaseContacts();
+	void			swapFrictionStreams();
+	void			swapNpCacheStreams();
+
+	void			flushUnused();
+	
+private:
+
+	PxMutex					mLock;
+	PxcNpMemBlockArray		mConstraints;
+	PxcNpMemBlockArray		mContacts[2];
+	PxcNpMemBlockArray		mFriction[2];
+	PxcNpMemBlockArray		mNpCache[2];
+	PxcNpMemBlockArray		mScratchBlocks;
+	PxArray<PxU8*>			mExceptionalConstraints;
+
+	PxcNpMemBlockArray		mUnused;
+
+	PxU32					mNpCacheActiveStream;
+	PxU32					mFrictionActiveStream;
+	PxU32					mCCDCacheActiveStream;
+	PxU32					mContactIndex;
+	PxU32					mAllocatedBlocks;
+	PxU32					mMaxBlocks;
+	PxU32					mInitialBlocks;
+	PxU32					mUsedBlocks;
+	PxU32					mMaxUsedBlocks;
+	PxcNpMemBlock*			mScratchBlockAddr;
+	PxU32					mNbScratchBlocks;
+	PxcScratchAllocator&	mScratchAllocator;
+
+	PxU32					mPeakConstraintAllocations;
+	PxU32					mConstraintAllocations;
+
+	PxcNpMemBlock*	acquire(PxcNpMemBlockArray& trackingArray, PxU32* allocationCount = NULL, PxU32* peakAllocationCount = NULL, bool isScratchAllocation = false);
+	void			release(PxcNpMemBlockArray& deadArray, PxU32* allocationCount = NULL);
+};
+
+}
+
+#endif

engine/third_party/physx/source/lowlevel/common/include/pipeline/PxcNpThreadContext.h

@@ -0,0 +1,200 @@
+// 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-2025 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 PXC_NP_THREAD_CONTEXT_H
+#define PXC_NP_THREAD_CONTEXT_H
+
+#include "geometry/PxGeometry.h"
+#include "geomutils/PxContactBuffer.h"
+#include "common/PxRenderOutput.h"
+
+#include "CmRenderBuffer.h"
+
+#include "PxvConfig.h"
+#include "CmScaling.h"
+#include "PxcNpCacheStreamPair.h"
+#include "PxcConstraintBlockStream.h"
+#include "PxcThreadCoherentCache.h"
+#include "PxcScratchAllocator.h"
+#include "foundation/PxBitMap.h"
+#include "../pcm/GuPersistentContactManifold.h"
+#include "../contact/GuContactMethodImpl.h"
+
+namespace physx
+{
+
+class PxsTransformCache;
+class PxsMaterialManager;
+
+namespace Sc
+{
+	class BodySim;
+}
+   
+/*!
+Per-thread context used by contact generation routines.
+*/
+
+struct PxcDataStreamPool
+{
+	PxU8* mDataStream;
+	PxI32 mSharedDataIndex;
+	PxU32 mDataStreamSize;
+	PxU32 mSharedDataIndexGPU;
+
+	bool isOverflown()	const
+	{
+		//FD: my expectaton is that reading those variables is atomic, shared indices are non-decreasing, 
+		//so we can only get a false overflow alert because of concurrency issues, which is not a big deal as it means 
+		//it did overflow a bit later  
+		return (mSharedDataIndex + mSharedDataIndexGPU) > mDataStreamSize;
+	}
+};
+
+struct PxcNpContext
+{
+	private:
+												PX_NOCOPY(PxcNpContext)
+	public:
+
+												PxcNpContext() :
+													mNpMemBlockPool			(mScratchAllocator),
+													mMeshContactMargin		(0.0f),
+													mToleranceLength		(0.0f),
+													mContactStreamPool		(NULL),
+													mPatchStreamPool		(NULL),
+													mForceAndIndiceStreamPool(NULL),
+													mFrictionPatchStreamPool(NULL),
+													mMaterialManager		(NULL)
+												{
+												}
+
+					PxcScratchAllocator			mScratchAllocator;
+					PxcNpMemBlockPool			mNpMemBlockPool;
+					PxReal						mMeshContactMargin;
+					PxReal						mToleranceLength;
+					Cm::RenderBuffer			mRenderBuffer;
+					PxcDataStreamPool*			mContactStreamPool;
+					PxcDataStreamPool*			mPatchStreamPool;
+					PxcDataStreamPool*			mForceAndIndiceStreamPool;
+					PxcDataStreamPool*			mFrictionPatchStreamPool;
+					PxsMaterialManager*			mMaterialManager;
+
+	PX_FORCE_INLINE	PxReal						getToleranceLength()		const	{ return mToleranceLength;					}
+	PX_FORCE_INLINE	void						setToleranceLength(PxReal x)		{ mToleranceLength = x;						}
+	PX_FORCE_INLINE	PxReal						getMeshContactMargin()		const	{ return mMeshContactMargin;				}
+	PX_FORCE_INLINE	void						setMeshContactMargin(PxReal x)		{ mMeshContactMargin = x;					}
+
+	PX_FORCE_INLINE	PxcNpMemBlockPool&			getNpMemBlockPool()					{ return mNpMemBlockPool;					}
+	PX_FORCE_INLINE	const PxcNpMemBlockPool&	getNpMemBlockPool()			const	{ return mNpMemBlockPool;					}
+	PX_FORCE_INLINE void						setMaterialManager(PxsMaterialManager* m){ mMaterialManager = m;				}
+	PX_FORCE_INLINE PxsMaterialManager*			getMaterialManager() const			{ return mMaterialManager;					}
+};
+
+class PxcNpThreadContext : public PxcThreadCoherentCache<PxcNpThreadContext, PxcNpContext>::EntryBase
+{
+												PX_NOCOPY(PxcNpThreadContext)
+public:
+												PxcNpThreadContext(PxcNpContext* params);
+												~PxcNpThreadContext();
+
+#if PX_ENABLE_SIM_STATS
+					void						clearStats();
+#else
+					PX_CATCH_UNDEFINED_ENABLE_SIM_STATS
+#endif
+
+	PX_FORCE_INLINE void						addLocalNewTouchCount(PxU32 newTouchCMCount)	{ mLocalNewTouchCount += newTouchCMCount;	}
+	PX_FORCE_INLINE void						addLocalLostTouchCount(PxU32 lostTouchCMCount)	{ mLocalLostTouchCount += lostTouchCMCount;	}
+	PX_FORCE_INLINE PxU32						getLocalNewTouchCount()					const	{ return mLocalNewTouchCount;				}
+	PX_FORCE_INLINE PxU32						getLocalLostTouchCount()				const	{ return mLocalLostTouchCount;				}
+
+	PX_FORCE_INLINE PxBitMap&					getLocalChangeTouch()							{ return mLocalChangeTouch;					}
+
+					void						reset(PxU32 cmCount);
+	// debugging
+					PxRenderOutput 				mRenderOutput;
+
+	// dsequeira: Need to think about this block pool allocation a bit more. Ideally we'd be 
+	// taking blocks from a single pool, except that we want to be able to selectively reclaim
+	// blocks if the user needs to defragment, depending on which artifacts they're willing
+	// to tolerate, such that the blocks we don't reclaim are contiguous.
+#if PX_ENABLE_SIM_STATS
+					PxU32						mDiscreteContactPairs	[PxGeometryType::eGEOMETRY_COUNT][PxGeometryType::eGEOMETRY_COUNT];
+					PxU32						mModifiedContactPairs	[PxGeometryType::eGEOMETRY_COUNT][PxGeometryType::eGEOMETRY_COUNT];
+#else
+					PX_CATCH_UNDEFINED_ENABLE_SIM_STATS
+#endif
+					PxcContactBlockStream 		mContactBlockStream;		// constraint block pool
+					PxcNpCacheStreamPair		mNpCacheStreamPair;			// narrow phase pairwise data cache
+
+	// Everything below here is scratch state. Most of it can even overlap.
+
+	// temporary contact buffer
+					PxContactBuffer				mContactBuffer;    
+
+	PX_ALIGN(16, Gu::MultiplePersistentContactManifold		mTempManifold); 
+
+					Gu::NarrowPhaseParams		mNarrowPhaseParams;
+
+	// DS: this stuff got moved here from the PxcNpPairContext. As Pierre says:
+	////////// PT: those members shouldn't be there in the end, it's not necessary
+					PxsTransformCache*			mTransformCache;
+					const PxReal*				mContactDistances;
+					bool						mPCM;
+					bool						mContactCache;
+					bool						mCreateAveragePoint;	// flag to enforce whether we create average points
+#if PX_ENABLE_SIM_STATS
+					PxU32						mCompressedCacheSize;
+					PxU32						mNbDiscreteContactPairsWithCacheHits;
+					PxU32						mNbDiscreteContactPairsWithContacts;
+#else
+					PX_CATCH_UNDEFINED_ENABLE_SIM_STATS
+#endif
+					PxReal						mDt; // AP: still needed for ccd
+					PxU32						mCCDPass;
+					PxU32						mCCDFaceIndex;
+
+					PxU32						mMaxPatches;
+
+					PxcDataStreamPool*			mContactStreamPool;
+					PxcDataStreamPool*			mPatchStreamPool;
+					PxcDataStreamPool*			mForceAndIndiceStreamPool; //this stream is used to store the force buffer and triangle index if we are performing mesh/heightfield contact gen
+					PxcDataStreamPool*			mFrictionPatchStreamPool;
+					PxsMaterialManager*			mMaterialManager;
+
+private:
+		// change touch handling.
+					PxBitMap					mLocalChangeTouch;
+					PxU32						mLocalNewTouchCount;
+					PxU32						mLocalLostTouchCount;
+};
+
+}
+
+#endif

engine/third_party/physx/source/lowlevel/common/include/pipeline/PxcNpWorkUnit.h

@@ -0,0 +1,211 @@
+// 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-2025 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 PXC_NP_WORK_UNIT_H
+#define PXC_NP_WORK_UNIT_H
+
+#include "PxConstraintDesc.h"
+#include "PxvGeometry.h"
+
+// PT: the shapeCore structs are 16-bytes aligned by design so the low 4 bits of their pointers are available.
+// We can store the geom types there since they fit. An alternative would be simply to read the types from
+// shapeCore->mGeometry.getType() but that is one more indirection/cache miss. We might be using other shapeCore
+// data everywhere we need the type so that might be irrelevant and could be revisited.
+PX_COMPILE_TIME_ASSERT(physx::PxGeometryType::eGEOMETRY_COUNT<16);
+
+namespace physx
+{
+struct PxsRigidCore;
+struct PxsShapeCore;
+
+namespace IG
+{
+	typedef PxU32 EdgeIndex;
+}
+
+struct PxcNpWorkUnitFlag
+{
+	enum Enum
+	{
+		eOUTPUT_CONTACTS			= 1 << 0,
+		eOUTPUT_CONSTRAINTS			= 1 << 1,
+		eDISABLE_STRONG_FRICTION	= 1 << 2,
+		eARTICULATION_BODY0			= 1 << 3,
+		eARTICULATION_BODY1			= 1 << 4,
+		eDYNAMIC_BODY0				= 1 << 5,
+		eDYNAMIC_BODY1				= 1 << 6,
+		eSOFT_BODY					= 1 << 7,
+		eMODIFIABLE_CONTACT			= 1 << 8,
+		eFORCE_THRESHOLD			= 1 << 9,
+		eDETECT_DISCRETE_CONTACT	= 1 << 10,
+		eHAS_KINEMATIC_ACTOR		= 1 << 11,
+		eDISABLE_RESPONSE			= 1 << 12,
+		eDETECT_CCD_CONTACTS		= 1 << 13,
+		eDOMINANCE_0				= 1 << 14,
+		eDOMINANCE_1				= 1 << 15,
+	};
+};
+
+struct PxcNpWorkUnitStatusFlag
+{
+	enum Enum
+	{
+		eHAS_NO_TOUCH				= (1 << 0),
+		eHAS_TOUCH					= (1 << 1),
+		//eHAS_SOLVER_CONSTRAINTS		= (1 << 2),
+		eREQUEST_CONSTRAINTS		= (1 << 3),
+		eHAS_CCD_RETOUCH			= (1 << 4),	// Marks pairs that are touching at a CCD pass and were touching at discrete collision or at a previous CCD pass already
+												// but we can not tell whether they lost contact in a pass before. We send them as pure eNOTIFY_TOUCH_CCD events to the 
+												// contact report callback if requested.
+		eDIRTY_MANAGER				= (1 << 5),
+		eREFRESHED_WITH_TOUCH		= (1 << 6),
+		eTOUCH_KNOWN				= eHAS_NO_TOUCH | eHAS_TOUCH	// The touch status is known (if narrowphase never ran for a pair then no flag will be set)
+	};
+};
+
+struct PxcNpWorkUnit
+{
+	const PxsRigidCore*	mRigidCore0;				// INPUT								//8
+	const PxsRigidCore*	mRigidCore1;				// INPUT								//16
+		
+	private:
+	const void*			mShapeCoreAndType0;			// INPUT								//24
+	const void*			mShapeCoreAndType1;			// INPUT								//32
+	public:
+
+	PxU8*				mCCDContacts;				// OUTPUT								//40
+	PxU8*				mFrictionDataPtr;			// INOUT								//48
+
+	PxU16				mFlags;						// INPUT								//50
+	PxU8				mFrictionPatchCount;		// INOUT 								//51
+	PxU8				mStatusFlags;				// OUTPUT (see PxcNpWorkUnitStatusFlag) //52
+
+	PxReal				mRestDistance;				// INPUT								//56
+
+	PxU32				mTransformCache0;			//										//60
+	PxU32				mTransformCache1;			//										//64
+	
+	IG::EdgeIndex		mEdgeIndex;					//inout the island gen edge index		//68
+	PxU32				mNpIndex;					//INPUT									//72
+
+	PxReal				mTorsionalPatchRadius;												//76
+	PxReal				mMinTorsionalPatchRadius;											//80
+	PxReal				mOffsetSlop;														//84
+																							//88 pading
+
+	///////////////////////////////////////////////////////////////////////////
+
+	PX_FORCE_INLINE	const void*	encode(const PxsShapeCore* shapeCore)
+	{
+		const PxU64 type = PxU64(shapeCore->mGeometry.getType());
+		PxU64 data = PxU64(shapeCore);
+		PX_ASSERT(!(data & 15));
+		data |= type;
+		return reinterpret_cast<const void*>(data);
+	}
+
+	PX_FORCE_INLINE	void	setShapeCore0(const PxsShapeCore* shapeCore)
+	{
+		mShapeCoreAndType0 = encode(shapeCore);
+	}
+
+	PX_FORCE_INLINE	void	setShapeCore1(const PxsShapeCore* shapeCore)
+	{
+		mShapeCoreAndType1 = encode(shapeCore);
+	}
+
+	PX_FORCE_INLINE	const PxsShapeCore*	getShapeCore0()	const
+	{
+		return reinterpret_cast<const PxsShapeCore*>(PxU64(mShapeCoreAndType0) & ~15);
+	}
+
+	PX_FORCE_INLINE	const PxsShapeCore*	getShapeCore1()	const
+	{
+		return reinterpret_cast<const PxsShapeCore*>(PxU64(mShapeCoreAndType1) & ~15);
+	}
+
+	PX_FORCE_INLINE	PxGeometryType::Enum	getGeomType0()	const
+	{
+		return PxGeometryType::Enum(PxU64(mShapeCoreAndType0) & 15);
+	}
+
+	PX_FORCE_INLINE	PxGeometryType::Enum	getGeomType1()	const
+	{
+		return PxGeometryType::Enum(PxU64(mShapeCoreAndType1) & 15);
+	}
+
+	///////////////////////////////////////////////////////////////////////////
+
+	PX_FORCE_INLINE	PxU8	getDominance0()	const
+	{
+		return (mFlags & PxcNpWorkUnitFlag::eDOMINANCE_0) ? 0 : 1;
+	}
+
+	PX_FORCE_INLINE	void	setDominance0(PxU8 v)
+	{
+		if(v==0)
+			mFlags |= PxcNpWorkUnitFlag::eDOMINANCE_0;
+		else
+			mFlags &= ~PxcNpWorkUnitFlag::eDOMINANCE_0;
+	}
+
+	PX_FORCE_INLINE	PxU8	getDominance1()	const
+	{
+		return (mFlags & PxcNpWorkUnitFlag::eDOMINANCE_1) ? 0 : 1;
+	}
+
+	PX_FORCE_INLINE	void	setDominance1(PxU8 v)
+	{
+		if(v==0)
+			mFlags |= PxcNpWorkUnitFlag::eDOMINANCE_1;
+		else
+			mFlags &= ~PxcNpWorkUnitFlag::eDOMINANCE_1;
+	}
+
+	PX_FORCE_INLINE	void	setInvMassScaleFromDominance(PxConstraintInvMassScale& invMassScales)	const
+	{
+		const PxReal dominance0 = getDominance0() ? 1.0f : 0.0f;
+		const PxReal dominance1 = getDominance1() ? 1.0f : 0.0f;
+
+		invMassScales.linear0 = invMassScales.angular0 = dominance0;
+		invMassScales.linear1 = invMassScales.angular1 = dominance1;
+	}
+
+	///////////////////////////////////////////////////////////////////////////
+
+	PX_FORCE_INLINE void	clearCachedState()
+	{
+		mFrictionDataPtr = NULL;
+		mFrictionPatchCount = 0;
+		mCCDContacts = NULL;
+	}
+};
+
+}
+
+#endif

engine/third_party/physx/source/lowlevel/common/include/utils/PxcScratchAllocator.h

@@ -0,0 +1,137 @@
+// 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-2025 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 PXC_SCRATCH_ALLOCATOR_H
+#define PXC_SCRATCH_ALLOCATOR_H
+
+#include "foundation/PxAssert.h"
+#include "PxvConfig.h"
+#include "foundation/PxMutex.h"
+#include "foundation/PxArray.h"
+#include "foundation/PxAllocator.h"
+#include "foundation/PxUserAllocated.h"
+
+namespace physx
+{
+class PxcScratchAllocator : public PxUserAllocated
+{
+	PX_NOCOPY(PxcScratchAllocator)
+public:
+	PxcScratchAllocator() : mStack("PxcScratchAllocator"), mStart(NULL), mSize(0)
+	{
+		mStack.reserve(64);
+		mStack.pushBack(0);
+	}
+
+	void setBlock(void* addr, PxU32 size)
+	{
+		PX_ASSERT(!(size&15));
+
+		// if the stack is not empty then some scratch memory was not freed on the previous frame. That's 
+		// likely indicative of a problem, because when the scratch block is too small the memory will have
+		// come from the heap
+
+		PX_ASSERT(mStack.size()==1);
+		mStack.popBack();
+
+		mStart = reinterpret_cast<PxU8*>(addr);
+		mSize = size;
+		mStack.pushBack(mStart + size);
+	}
+
+	void* allocAll(PxU32& size)
+	{
+		PxMutex::ScopedLock lock(mLock);
+		PX_ASSERT(mStack.size()>0);
+		size = PxU32(mStack.back()-mStart);
+
+		if(size==0)
+			return NULL;
+
+		mStack.pushBack(mStart);
+		return mStart;
+	}
+
+	void* alloc(PxU32 requestedSize, bool fallBackToHeap = false)
+	{
+		requestedSize = (requestedSize+15)&~15;
+
+		PxMutex::ScopedLock lock(mLock);
+		PX_ASSERT(mStack.size()>=1);
+
+		PxU8* top = mStack.back();
+
+		if(top - mStart >= ptrdiff_t(requestedSize))
+		{
+			PxU8* addr = top - requestedSize;
+			mStack.pushBack(addr);
+			return addr;
+		}
+
+		if(!fallBackToHeap)
+			return NULL;
+
+		return PX_ALLOC(requestedSize, "Scratch Block Fallback");
+	}
+
+	void free(void* addr)
+	{
+		PX_ASSERT(addr!=NULL);
+		if(!isScratchAddr(addr))
+		{
+			PX_FREE(addr);
+			return;
+		}
+
+		PxMutex::ScopedLock lock(mLock);
+		PX_ASSERT(mStack.size()>1);
+
+		PxU32 i=mStack.size()-1;		
+		while(mStack[i]<addr)
+			i--;
+
+		PX_ASSERT(mStack[i]==addr);
+		mStack.remove(i);
+	}
+
+	bool isScratchAddr(void* addr) const
+	{
+		PxU8* a = reinterpret_cast<PxU8*>(addr);
+		return a>= mStart && a<mStart+mSize;
+	}
+
+private:
+	PxMutex				mLock;
+	PxArray<PxU8*>		mStack;
+	PxU8*				mStart;
+	PxU32				mSize;
+};
+
+}
+
+#endif

engine/third_party/physx/source/lowlevel/common/include/utils/PxcThreadCoherentCache.h

@@ -0,0 +1,148 @@
+// 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-2025 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 PXC_THREAD_COHERENT_CACHE_H
+#define PXC_THREAD_COHERENT_CACHE_H
+
+#include "foundation/PxMutex.h"
+#include "foundation/PxAllocator.h"
+#include "foundation/PxSList.h"
+
+namespace physx
+{
+
+class PxsContext;
+/*!
+Controls a pool of large objects which must be thread safe. 
+Tries to return the object most recently used by the thread(for better cache coherancy).
+Assumes the object has a default contructor.
+
+(Note the semantics are different to a pool because we dont want to construct/destroy each time
+an object is requested, which may be expensive).
+
+TODO: add thread coherancy.
+*/
+template<class T, class Params>
+class PxcThreadCoherentCache : public PxAlignedAllocator<16, PxReflectionAllocator<T> >
+{
+	typedef PxAlignedAllocator<16, PxReflectionAllocator<T> > Allocator;
+	PX_NOCOPY(PxcThreadCoherentCache)
+public:
+
+	typedef PxSListEntry EntryBase;
+
+	PX_INLINE PxcThreadCoherentCache(Params* params, const Allocator& alloc = Allocator()) : Allocator(alloc), mParams(params)
+	{
+	}
+
+	PX_INLINE ~PxcThreadCoherentCache()
+	{
+		T* np = static_cast<T*>(root.pop());
+
+		while(np!=NULL)
+		{
+			np->~T();
+			Allocator::deallocate(np);
+			np = static_cast<T*>(root.pop());
+		}
+	}
+
+	PX_INLINE T* get()
+	{
+		T* rv = static_cast<T*>(root.pop());
+		if(rv==NULL)
+		{
+			rv = reinterpret_cast<T*>(Allocator::allocate(sizeof(T), PX_FL));
+			PX_PLACEMENT_NEW(rv, T(mParams));
+		}
+
+		return rv;
+	}
+
+	PX_INLINE void put(T* item)
+	{
+		root.push(*item);
+	}
+
+
+private:
+	PxSList root;
+	Params* mParams;
+
+	template<class T2, class P2>
+	friend class PxcThreadCoherentCacheIterator;
+};
+
+/*!
+Used to iterate over all objects controlled by the cache.
+
+Note: The iterator flushes the cache(extracts all items on construction and adds them back on
+destruction so we can iterate the list in a safe manner).
+*/
+template<class T, class Params> 
+class PxcThreadCoherentCacheIterator
+{
+public:
+	PxcThreadCoherentCacheIterator(PxcThreadCoherentCache<T, Params>& cache) : mCache(cache)
+	{
+		mNext = cache.root.flush();
+		mFirst = mNext;
+	}
+	~PxcThreadCoherentCacheIterator()
+	{
+		PxSListEntry* np = mFirst;
+		while(np != NULL)
+		{
+			PxSListEntry* npNext = np->next();
+			mCache.root.push(*np);
+			np = npNext;
+		}
+	}
+
+	PX_INLINE T* getNext()
+	{
+		if(mNext == NULL)
+			return NULL;
+
+		T* rv = static_cast<T*>(mNext);
+		mNext = mNext->next();
+
+		return rv;
+	}
+private:
+
+	PxcThreadCoherentCacheIterator<T, Params>& operator=(const PxcThreadCoherentCacheIterator<T, Params>&);
+	PxcThreadCoherentCache<T, Params> &mCache;
+	PxSListEntry* mNext;
+	PxSListEntry* mFirst;
+	
+};
+
+}
+
+#endif