forked from LeenkxTeam/LNXSDK
		
	
		
			
	
	
		
			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
							 | 
						||
| 
								 | 
							
								
							 |