66 lines
		
	
	
		
			2.6 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
		
		
			
		
	
	
			66 lines
		
	
	
		
			2.6 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
| 
								 | 
							
								/*
							 | 
						||
| 
								 | 
							
								Bullet Continuous Collision Detection and Physics Library, http://bulletphysics.org
							 | 
						||
| 
								 | 
							
								Copyright (C) 2006, 2007 Sony Computer Entertainment Inc. 
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								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_UNIVERSAL_CONSTRAINT_H
							 | 
						||
| 
								 | 
							
								#define BT_UNIVERSAL_CONSTRAINT_H
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								#include "LinearMath/btVector3.h"
							 | 
						||
| 
								 | 
							
								#include "btTypedConstraint.h"
							 | 
						||
| 
								 | 
							
								#include "btGeneric6DofConstraint.h"
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								/// Constraint similar to ODE Universal Joint
							 | 
						||
| 
								 | 
							
								/// has 2 rotatioonal degrees of freedom, similar to Euler rotations around Z (axis 1)
							 | 
						||
| 
								 | 
							
								/// and Y (axis 2)
							 | 
						||
| 
								 | 
							
								/// Description from ODE manual : 
							 | 
						||
| 
								 | 
							
								/// "Given axis 1 on body 1, and axis 2 on body 2 that is perpendicular to axis 1, it keeps them perpendicular. 
							 | 
						||
| 
								 | 
							
								/// In other words, rotation of the two bodies about the direction perpendicular to the two axes will be equal."
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								ATTRIBUTE_ALIGNED16(class) btUniversalConstraint : public btGeneric6DofConstraint
							 | 
						||
| 
								 | 
							
								{
							 | 
						||
| 
								 | 
							
								protected:
							 | 
						||
| 
								 | 
							
									btVector3	m_anchor;
							 | 
						||
| 
								 | 
							
									btVector3	m_axis1;
							 | 
						||
| 
								 | 
							
									btVector3	m_axis2;
							 | 
						||
| 
								 | 
							
								public:
							 | 
						||
| 
								 | 
							
									
							 | 
						||
| 
								 | 
							
									BT_DECLARE_ALIGNED_ALLOCATOR();
							 | 
						||
| 
								 | 
							
									
							 | 
						||
| 
								 | 
							
									// constructor
							 | 
						||
| 
								 | 
							
									// anchor, axis1 and axis2 are in world coordinate system
							 | 
						||
| 
								 | 
							
									// axis1 must be orthogonal to axis2
							 | 
						||
| 
								 | 
							
								    btUniversalConstraint(btRigidBody& rbA, btRigidBody& rbB, const btVector3& anchor, const btVector3& axis1, const btVector3& axis2);
							 | 
						||
| 
								 | 
							
									// access
							 | 
						||
| 
								 | 
							
									const btVector3& getAnchor() { return m_calculatedTransformA.getOrigin(); }
							 | 
						||
| 
								 | 
							
									const btVector3& getAnchor2() { return m_calculatedTransformB.getOrigin(); }
							 | 
						||
| 
								 | 
							
									const btVector3& getAxis1() { return m_axis1; }
							 | 
						||
| 
								 | 
							
									const btVector3& getAxis2() { return m_axis2; }
							 | 
						||
| 
								 | 
							
									btScalar getAngle1() { return getAngle(2); }
							 | 
						||
| 
								 | 
							
									btScalar getAngle2() { return getAngle(1); }
							 | 
						||
| 
								 | 
							
									// limits
							 | 
						||
| 
								 | 
							
									void setUpperLimit(btScalar ang1max, btScalar ang2max) { setAngularUpperLimit(btVector3(0.f, ang1max, ang2max)); }
							 | 
						||
| 
								 | 
							
									void setLowerLimit(btScalar ang1min, btScalar ang2min) { setAngularLowerLimit(btVector3(0.f, ang1min, ang2min)); }
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
									void setAxis( const btVector3& axis1, const btVector3& axis2);
							 | 
						||
| 
								 | 
							
								};
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								#endif // BT_UNIVERSAL_CONSTRAINT_H
							 | 
						||
| 
								 | 
							
								
							 |