expose the local inertial frame for each link in the shared memory API
struct b3LinkState
{
double m_worldPosition[3];//this is the inertial frame
double m_worldOrientation[4];
double m_localInertialPosition[3];//this is the local frame from inertial to link frame
double m_localInertialOrientation[4];
};
const btTransform link_frame_world =
inertial_frame_world * m_local_inertial_frame->inverse();
This commit is contained in:
@@ -197,7 +197,9 @@ struct SendActualStateArgs
|
||||
double m_jointReactionForces[6*MAX_DEGREE_OF_FREEDOM];
|
||||
|
||||
double m_jointMotorForce[MAX_DEGREE_OF_FREEDOM];
|
||||
|
||||
double m_linkState[7*MAX_NUM_LINKS];
|
||||
double m_linkLocalInertialFrames[7*MAX_NUM_LINKS];
|
||||
};
|
||||
|
||||
enum EnumSensorTypes
|
||||
|
||||
Reference in New Issue
Block a user