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
 | ||
|  | 
 |