16 #ifndef BT_MULTIBODY_LINK_H 17 #define BT_MULTIBODY_LINK_H 30 #define BT_MULTIBODYLINK_INCLUDE_PLANAR_JOINTS 31 #define TEST_SPATIAL_ALGEBRA_LAYER 158 m_zeroRotParentToThis(0, 0, 0, 1),
159 m_cachedRotParentToThis(0, 0, 0, 1),
171 m_jointLowerLimit(0),
172 m_jointUpperLimit(0),
174 m_jointMaxVelocity(0)
185 m_appliedConstraintForce.
setValue(0,0,0);
186 m_appliedConstraintTorque.
setValue(0,0,0);
188 m_jointPos[0] = m_jointPos[1] = m_jointPos[2] = m_jointPos[4] = m_jointPos[5] = m_jointPos[6] = 0.f;
190 m_jointTorque[0] = m_jointTorque[1] = m_jointTorque[2] = m_jointTorque[3] = m_jointTorque[4] = m_jointTorque[5] = 0.f;
197 btScalar *pJointPos = (pq ? pq : &m_jointPos[0]);
204 m_cachedRVector = m_dVector +
quatRotate(m_cachedRotParentToThis,m_eVector);
218 m_cachedRVector = m_dVector +
quatRotate(m_cachedRotParentToThis,m_eVector);
232 m_cachedRVector = m_dVector +
quatRotate(m_cachedRotParentToThis,m_eVector);
246 #endif //BT_MULTIBODY_LINK_H btScalar m_jointLowerLimit
btQuaternion m_zeroRotParentToThis
const btVector3 & getAxisBottom(int dof) const
btVector3 m_appliedConstraintForce
void setValue(const btScalar &_x, const btScalar &_y, const btScalar &_z)
btVector3 m_cachedRVector
eFeatherstoneJointType m_jointType
class btMultiBodyLinkCollider * m_collider
void updateCacheMultiDof(btScalar *pq=0)
void setAxisTop(int dof, const btScalar &x, const btScalar &y, const btScalar &z)
btSpatialMotionVector m_absFrameLocVelocity
btVector3 quatRotate(const btQuaternion &rotation, const btVector3 &v)
btScalar m_jointTorque[6]
btScalar m_jointUpperLimit
btQuaternion m_cachedRotParentToThis
btSpatialMotionVector m_axes[6]
void setAxisBottom(int dof, const btVector3 &axis)
btVector3 can be used to represent 3D points and vectors.
btVector3 m_appliedTorque
btSpatialMotionVector m_absFrameTotVelocity
btVector3 m_appliedConstraintTorque
BT_DECLARE_ALIGNED_ALLOCATOR()
btTransform m_cachedWorldTransform
void setAxisTop(int dof, const btVector3 &axis)
The btQuaternion implements quaternion to perform linear algebra rotations in combination with btMatr...
struct btMultiBodyJointFeedback * m_jointFeedback
const btVector3 & getAxisTop(int dof) const
void setAxisBottom(int dof, const btScalar &x, const btScalar &y, const btScalar &z)
float btScalar
The btScalar type abstracts floating point numbers, to easily switch between double and single floati...
btScalar m_jointMaxVelocity