initial commit, 4.5 stable

thirdparty/jolt_physics/Jolt/Physics/Collision/Shape/SubShapeIDPair.h

@@ -0,0 +1,65 @@
+// Jolt Physics Library (https://github.com/jrouwe/JoltPhysics)
+// SPDX-FileCopyrightText: 2021 Jorrit Rouwe
+// SPDX-License-Identifier: MIT
+
+#pragma once
+
+#include <Jolt/Physics/Body/BodyID.h>
+#include <Jolt/Physics/Collision/Shape/SubShapeID.h>
+#include <Jolt/Core/HashCombine.h>
+
+JPH_NAMESPACE_BEGIN
+
+/// A pair of bodies and their sub shape ID's. Can be used as a key in a map to find a contact point.
+class SubShapeIDPair
+{
+public:
+	JPH_OVERRIDE_NEW_DELETE
+
+	/// Constructor
+							SubShapeIDPair() = default;
+							SubShapeIDPair(const BodyID &inBody1ID, const SubShapeID &inSubShapeID1, const BodyID &inBody2ID, const SubShapeID &inSubShapeID2) : mBody1ID(inBody1ID), mSubShapeID1(inSubShapeID1), mBody2ID(inBody2ID), mSubShapeID2(inSubShapeID2) { }
+	SubShapeIDPair &		operator = (const SubShapeIDPair &) = default;
+							SubShapeIDPair(const SubShapeIDPair &) = default;
+
+	/// Equality operator
+	inline bool				operator == (const SubShapeIDPair &inRHS) const
+	{
+		return UVec4::sLoadInt4(reinterpret_cast<const uint32 *>(this)) == UVec4::sLoadInt4(reinterpret_cast<const uint32 *>(&inRHS));
+	}
+
+	/// Less than operator, used to consistently order contact points for a deterministic simulation
+	inline bool				operator < (const SubShapeIDPair &inRHS) const
+	{
+		if (mBody1ID != inRHS.mBody1ID)
+			return mBody1ID < inRHS.mBody1ID;
+
+		if (mSubShapeID1.GetValue() != inRHS.mSubShapeID1.GetValue())
+			return mSubShapeID1.GetValue() < inRHS.mSubShapeID1.GetValue();
+
+		if (mBody2ID != inRHS.mBody2ID)
+			return mBody2ID < inRHS.mBody2ID;
+
+		return mSubShapeID2.GetValue() < inRHS.mSubShapeID2.GetValue();
+	}
+
+	const BodyID &			GetBody1ID() const				{ return mBody1ID; }
+	const SubShapeID &		GetSubShapeID1() const			{ return mSubShapeID1; }
+	const BodyID &			GetBody2ID() const				{ return mBody2ID; }
+	const SubShapeID &		GetSubShapeID2() const			{ return mSubShapeID2; }
+
+	uint64					GetHash() const					{ return HashBytes(this, sizeof(SubShapeIDPair)); }
+
+private:
+	BodyID					mBody1ID;
+	SubShapeID				mSubShapeID1;
+	BodyID					mBody2ID;
+	SubShapeID				mSubShapeID2;
+};
+
+static_assert(sizeof(SubShapeIDPair) == 16, "Unexpected size");
+static_assert(alignof(SubShapeIDPair) == 4, "Assuming 4 byte aligned");
+
+JPH_NAMESPACE_END
+
+JPH_MAKE_STD_HASH(JPH::SubShapeIDPair)