270 lines
		
	
	
		
			7.5 KiB
		
	
	
	
		
			C++
		
	
	
	
	
	
			
		
		
	
	
			270 lines
		
	
	
		
			7.5 KiB
		
	
	
	
		
			C++
		
	
	
	
	
	
| /*
 | |
| Bullet Continuous Collision Detection and Physics Library
 | |
| Copyright (c) 2003-2006 Erwin Coumans  http://continuousphysics.com/Bullet/
 | |
| 
 | |
| 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.
 | |
| */
 | |
| 
 | |
| #ifndef BT_BROADPHASE_PROXY_H
 | |
| #define BT_BROADPHASE_PROXY_H
 | |
| 
 | |
| #include "LinearMath/btScalar.h" //for SIMD_FORCE_INLINE
 | |
| #include "LinearMath/btVector3.h"
 | |
| #include "LinearMath/btAlignedAllocator.h"
 | |
| 
 | |
| 
 | |
| /// btDispatcher uses these types
 | |
| /// IMPORTANT NOTE:The types are ordered polyhedral, implicit convex and concave
 | |
| /// to facilitate type checking
 | |
| /// CUSTOM_POLYHEDRAL_SHAPE_TYPE,CUSTOM_CONVEX_SHAPE_TYPE and CUSTOM_CONCAVE_SHAPE_TYPE can be used to extend Bullet without modifying source code
 | |
| enum BroadphaseNativeTypes
 | |
| {
 | |
| 	// polyhedral convex shapes
 | |
| 	BOX_SHAPE_PROXYTYPE,
 | |
| 	TRIANGLE_SHAPE_PROXYTYPE,
 | |
| 	TETRAHEDRAL_SHAPE_PROXYTYPE,
 | |
| 	CONVEX_TRIANGLEMESH_SHAPE_PROXYTYPE,
 | |
| 	CONVEX_HULL_SHAPE_PROXYTYPE,
 | |
| 	CONVEX_POINT_CLOUD_SHAPE_PROXYTYPE,
 | |
| 	CUSTOM_POLYHEDRAL_SHAPE_TYPE,
 | |
| //implicit convex shapes
 | |
| IMPLICIT_CONVEX_SHAPES_START_HERE,
 | |
| 	SPHERE_SHAPE_PROXYTYPE,
 | |
| 	MULTI_SPHERE_SHAPE_PROXYTYPE,
 | |
| 	CAPSULE_SHAPE_PROXYTYPE,
 | |
| 	CONE_SHAPE_PROXYTYPE,
 | |
| 	CONVEX_SHAPE_PROXYTYPE,
 | |
| 	CYLINDER_SHAPE_PROXYTYPE,
 | |
| 	UNIFORM_SCALING_SHAPE_PROXYTYPE,
 | |
| 	MINKOWSKI_SUM_SHAPE_PROXYTYPE,
 | |
| 	MINKOWSKI_DIFFERENCE_SHAPE_PROXYTYPE,
 | |
| 	BOX_2D_SHAPE_PROXYTYPE,
 | |
| 	CONVEX_2D_SHAPE_PROXYTYPE,
 | |
| 	CUSTOM_CONVEX_SHAPE_TYPE,
 | |
| //concave shapes
 | |
| CONCAVE_SHAPES_START_HERE,
 | |
| 	//keep all the convex shapetype below here, for the check IsConvexShape in broadphase proxy!
 | |
| 	TRIANGLE_MESH_SHAPE_PROXYTYPE,
 | |
| 	SCALED_TRIANGLE_MESH_SHAPE_PROXYTYPE,
 | |
| 	///used for demo integration FAST/Swift collision library and Bullet
 | |
| 	FAST_CONCAVE_MESH_PROXYTYPE,
 | |
| 	//terrain
 | |
| 	TERRAIN_SHAPE_PROXYTYPE,
 | |
| ///Used for GIMPACT Trimesh integration
 | |
| 	GIMPACT_SHAPE_PROXYTYPE,
 | |
| ///Multimaterial mesh
 | |
|     MULTIMATERIAL_TRIANGLE_MESH_PROXYTYPE,
 | |
| 	
 | |
| 	EMPTY_SHAPE_PROXYTYPE,
 | |
| 	STATIC_PLANE_PROXYTYPE,
 | |
| 	CUSTOM_CONCAVE_SHAPE_TYPE,
 | |
| CONCAVE_SHAPES_END_HERE,
 | |
| 
 | |
| 	COMPOUND_SHAPE_PROXYTYPE,
 | |
| 
 | |
| 	SOFTBODY_SHAPE_PROXYTYPE,
 | |
| 	HFFLUID_SHAPE_PROXYTYPE,
 | |
| 	HFFLUID_BUOYANT_CONVEX_SHAPE_PROXYTYPE,
 | |
| 	INVALID_SHAPE_PROXYTYPE,
 | |
| 
 | |
| 	MAX_BROADPHASE_COLLISION_TYPES
 | |
| 	
 | |
| };
 | |
| 
 | |
| 
 | |
| ///The btBroadphaseProxy is the main class that can be used with the Bullet broadphases. 
 | |
| ///It stores collision shape type information, collision filter information and a client object, typically a btCollisionObject or btRigidBody.
 | |
| ATTRIBUTE_ALIGNED16(struct) btBroadphaseProxy
 | |
| {
 | |
| 
 | |
| BT_DECLARE_ALIGNED_ALLOCATOR();
 | |
| 	
 | |
| 	///optional filtering to cull potential collisions
 | |
| 	enum CollisionFilterGroups
 | |
| 	{
 | |
| 	        DefaultFilter = 1,
 | |
| 	        StaticFilter = 2,
 | |
| 	        KinematicFilter = 4,
 | |
| 	        DebrisFilter = 8,
 | |
| 			SensorTrigger = 16,
 | |
| 			CharacterFilter = 32,
 | |
| 	        AllFilter = -1 //all bits sets: DefaultFilter | StaticFilter | KinematicFilter | DebrisFilter | SensorTrigger
 | |
| 	};
 | |
| 
 | |
| 	//Usually the client btCollisionObject or Rigidbody class
 | |
| 	void*	m_clientObject;
 | |
| 	int		m_collisionFilterGroup;
 | |
| 	int		m_collisionFilterMask;
 | |
| 
 | |
| 	int		m_uniqueId;//m_uniqueId is introduced for paircache. could get rid of this, by calculating the address offset etc.
 | |
| 
 | |
| 	btVector3	m_aabbMin;
 | |
| 	btVector3	m_aabbMax;
 | |
| 
 | |
| 	SIMD_FORCE_INLINE int getUid() const
 | |
| 	{
 | |
| 		return m_uniqueId;
 | |
| 	}
 | |
| 
 | |
| 	//used for memory pools
 | |
| 	btBroadphaseProxy() :m_clientObject(0)
 | |
| 	{
 | |
| 	}
 | |
| 
 | |
| 	btBroadphaseProxy(const btVector3& aabbMin,const btVector3& aabbMax,void* userPtr, int collisionFilterGroup,  int collisionFilterMask)
 | |
| 		:m_clientObject(userPtr),
 | |
| 		m_collisionFilterGroup(collisionFilterGroup),
 | |
| 		m_collisionFilterMask(collisionFilterMask),
 | |
| 		m_aabbMin(aabbMin),
 | |
| 		m_aabbMax(aabbMax)
 | |
| 	{
 | |
| 	}
 | |
| 
 | |
| 	
 | |
| 
 | |
| 	static SIMD_FORCE_INLINE bool isPolyhedral(int proxyType)
 | |
| 	{
 | |
| 		return (proxyType  < IMPLICIT_CONVEX_SHAPES_START_HERE);
 | |
| 	}
 | |
| 
 | |
| 	static SIMD_FORCE_INLINE bool	isConvex(int proxyType)
 | |
| 	{
 | |
| 		return (proxyType < CONCAVE_SHAPES_START_HERE);
 | |
| 	}
 | |
| 
 | |
| 	static SIMD_FORCE_INLINE bool	isNonMoving(int proxyType)
 | |
| 	{
 | |
| 		return (isConcave(proxyType) && !(proxyType==GIMPACT_SHAPE_PROXYTYPE));
 | |
| 	}
 | |
| 
 | |
| 	static SIMD_FORCE_INLINE bool	isConcave(int proxyType)
 | |
| 	{
 | |
| 		return ((proxyType > CONCAVE_SHAPES_START_HERE) &&
 | |
| 			(proxyType < CONCAVE_SHAPES_END_HERE));
 | |
| 	}
 | |
| 	static SIMD_FORCE_INLINE bool	isCompound(int proxyType)
 | |
| 	{
 | |
| 		return (proxyType == COMPOUND_SHAPE_PROXYTYPE);
 | |
| 	}
 | |
| 
 | |
| 	static SIMD_FORCE_INLINE bool	isSoftBody(int proxyType)
 | |
| 	{
 | |
| 		return (proxyType == SOFTBODY_SHAPE_PROXYTYPE);
 | |
| 	}
 | |
| 
 | |
| 	static SIMD_FORCE_INLINE bool isInfinite(int proxyType)
 | |
| 	{
 | |
| 		return (proxyType == STATIC_PLANE_PROXYTYPE);
 | |
| 	}
 | |
| 
 | |
| 	static SIMD_FORCE_INLINE bool isConvex2d(int proxyType)
 | |
| 	{
 | |
| 		return (proxyType == BOX_2D_SHAPE_PROXYTYPE) ||	(proxyType == CONVEX_2D_SHAPE_PROXYTYPE);
 | |
| 	}
 | |
| 
 | |
| 	
 | |
| }
 | |
| ;
 | |
| 
 | |
| class btCollisionAlgorithm;
 | |
| 
 | |
| struct btBroadphaseProxy;
 | |
| 
 | |
| 
 | |
| 
 | |
| ///The btBroadphasePair class contains a pair of aabb-overlapping objects.
 | |
| ///A btDispatcher can search a btCollisionAlgorithm that performs exact/narrowphase collision detection on the actual collision shapes.
 | |
| ATTRIBUTE_ALIGNED16(struct) btBroadphasePair
 | |
| {
 | |
| 	btBroadphasePair ()
 | |
| 		:
 | |
| 	m_pProxy0(0),
 | |
| 		m_pProxy1(0),
 | |
| 		m_algorithm(0),
 | |
| 		m_internalInfo1(0)
 | |
| 	{
 | |
| 	}
 | |
| 
 | |
| BT_DECLARE_ALIGNED_ALLOCATOR();
 | |
| 
 | |
| 	btBroadphasePair(const btBroadphasePair& other)
 | |
| 		:		m_pProxy0(other.m_pProxy0),
 | |
| 				m_pProxy1(other.m_pProxy1),
 | |
| 				m_algorithm(other.m_algorithm),
 | |
| 				m_internalInfo1(other.m_internalInfo1)
 | |
| 	{
 | |
| 	}
 | |
| 	btBroadphasePair(btBroadphaseProxy& proxy0,btBroadphaseProxy& proxy1)
 | |
| 	{
 | |
| 
 | |
| 		//keep them sorted, so the std::set operations work
 | |
| 		if (proxy0.m_uniqueId < proxy1.m_uniqueId)
 | |
|         { 
 | |
|             m_pProxy0 = &proxy0; 
 | |
|             m_pProxy1 = &proxy1; 
 | |
|         }
 | |
|         else 
 | |
|         { 
 | |
| 			m_pProxy0 = &proxy1; 
 | |
|             m_pProxy1 = &proxy0; 
 | |
|         }
 | |
| 
 | |
| 		m_algorithm = 0;
 | |
| 		m_internalInfo1 = 0;
 | |
| 
 | |
| 	}
 | |
| 	
 | |
| 	btBroadphaseProxy* m_pProxy0;
 | |
| 	btBroadphaseProxy* m_pProxy1;
 | |
| 	
 | |
| 	mutable btCollisionAlgorithm* m_algorithm;
 | |
| 	union { void* m_internalInfo1; int m_internalTmpValue;};//don't use this data, it will be removed in future version.
 | |
| 
 | |
| };
 | |
| 
 | |
| /*
 | |
| //comparison for set operation, see Solid DT_Encounter
 | |
| SIMD_FORCE_INLINE bool operator<(const btBroadphasePair& a, const btBroadphasePair& b) 
 | |
| { 
 | |
|     return a.m_pProxy0 < b.m_pProxy0 || 
 | |
|         (a.m_pProxy0 == b.m_pProxy0 && a.m_pProxy1 < b.m_pProxy1); 
 | |
| }
 | |
| */
 | |
| 
 | |
| 
 | |
| 
 | |
| class btBroadphasePairSortPredicate
 | |
| {
 | |
| 	public:
 | |
| 
 | |
| 		bool operator() ( const btBroadphasePair& a, const btBroadphasePair& b ) const
 | |
| 		{
 | |
| 			const int uidA0 = a.m_pProxy0 ? a.m_pProxy0->m_uniqueId : -1;
 | |
| 			const int uidB0 = b.m_pProxy0 ? b.m_pProxy0->m_uniqueId : -1;
 | |
| 			const int uidA1 = a.m_pProxy1 ? a.m_pProxy1->m_uniqueId : -1;
 | |
| 			const int uidB1 = b.m_pProxy1 ? b.m_pProxy1->m_uniqueId : -1;
 | |
| 
 | |
| 			 return uidA0 > uidB0 || 
 | |
| 				(a.m_pProxy0 == b.m_pProxy0 && uidA1 > uidB1) ||
 | |
| 				(a.m_pProxy0 == b.m_pProxy0 && a.m_pProxy1 == b.m_pProxy1 && a.m_algorithm > b.m_algorithm); 
 | |
| 		}
 | |
| };
 | |
| 
 | |
| 
 | |
| SIMD_FORCE_INLINE bool operator==(const btBroadphasePair& a, const btBroadphasePair& b) 
 | |
| {
 | |
| 	 return (a.m_pProxy0 == b.m_pProxy0) && (a.m_pProxy1 == b.m_pProxy1);
 | |
| }
 | |
| 
 | |
| 
 | |
| #endif //BT_BROADPHASE_PROXY_H
 | |
| 
 |