Public Member Functions |
| | RigidBody (const std::string &name="") |
| | constructor
|
|
virtual | ~RigidBody () |
| | destructor
|
|
void | addDependency (Constraint *constraint_) |
|
virtual void | updateT (double t) |
|
virtual void | updateh (double t, int j=0) |
|
virtual void | updateh0Fromh1 (double t) |
|
virtual void | updateW0FromW1 (double t) |
|
virtual void | updateV0FromV1 (double t) |
|
virtual void | updatehInverseKinetics (double t, int j=0) |
|
virtual void | updateStateDerivativeDependentVariables (double t) |
|
virtual void | updateM (double t, int i=0) |
|
virtual void | updateStateDependentVariables (double t) |
|
virtual void | updateJacobians (double t, int j=0) |
|
void | updateJacobians0 (double t) |
|
void | updateJacobians1 (double t) |
|
virtual void | calcqSize () |
|
virtual void | calcuSize (int j=0) |
| virtual void | updateqRef (const fmatvec::Vec &ref) |
| | references to positions of dynamic system parent
|
| virtual void | updateuRef (const fmatvec::Vec &ref) |
| | references to velocities of dynamic system parent
|
| virtual void | updateTRef (const fmatvec::Mat &ref) |
| | references to linear transformation matrix between differentiated positions and velocities of dynamic system parent
|
|
virtual void | init (InitStage stage) |
| | initialize object at start of simulation with respect to contours and frames
|
|
virtual void | initz () |
| | initialize state of object at start of simulation
|
|
virtual void | facLLM (int i=0) |
| | perform Cholesky decomposition of mass martix
|
|
virtual void | setUpInverseKinetics () |
| | TODO.
|
| virtual std::string | getType () const |
| virtual void | plot (double t, double dt=1) |
| | plots time dependent data
|
|
virtual void | updateKinematicsForSelectedFrame (double t) |
| | updates kinematics of kinematic Frame starting from reference Frame
|
|
virtual void | updateJacobiansForSelectedFrame0 (double t) |
| | updates JACOBIAN for kinematics starting from reference Frame
|
|
virtual void | updateKinematicsForRemainingFramesAndContours (double t) |
| | updates kinematics for remaining Frames starting with and from cog Frame
|
|
virtual void | updateJacobiansForRemainingFramesAndContours (double t, int j=0) |
| | updates remaining JACOBIANS for kinematics starting with and from cog Frame
|
|
virtual void | updateJacobiansForRemainingFramesAndContours1 (double t) |
| void | setTranslation (Translation *fPrPK_) |
| | set Kinematic for translational motion
|
| void | setRotation (Rotation *fAPK_) |
| | set Kinematic for rotational motion
|
| Translation * | getTranslation () |
| | get Kinematic for translational motion
|
| Rotation * | getRotation () |
| | get Kinematic for rotational motion
|
|
void | setJacobianOfTranslation (Jacobian *fPJT_) |
|
void | setJacobianOfRotation (Jacobian *fPJR_) |
|
void | setDerivativeOfJacobianOfTranslation (DerivativeOfJacobian *fPdJT_) |
|
void | setDerivativeOfJacobianOfRotation (DerivativeOfJacobian *fPdJR_) |
|
void | setGuidingVelocityOfTranslation (GuidingVelocity *fPjT_) |
| | Sets the time dependent function for the guiding velocity of translation.
|
|
void | setGuidingVelocityOfRotation (GuidingVelocity *fPjR_) |
| | Sets the time dependent function for the guiding velocity of rotation.
|
|
void | setDerivativeOfGuidingVelocityOfTranslation (DerivativeOfGuidingVelocity *fPdjT_) |
| | Sets the time dependent function for the derivative of the guilding velocity of translation.
|
|
void | setDerivativeOfGuidingVelocityOfRotation (DerivativeOfGuidingVelocity *fPdjR_) |
| | Sets the time dependent function for the derivative of the guilding velocity of rotation.
|
|
void | setMass (double m_) |
|
double | getMass () const |
|
FixedRelativeFrame * | getFrameForKinematics () |
|
FixedRelativeFrame * | getFrameC () |
|
void | isFrameOfBodyForRotation (bool cb_) |
| void | setInertiaTensor (const fmatvec::SymMat3 &RThetaR, Frame *frame=0) |
|
const fmatvec::SymMat3 & | getInertiaTensor () const |
|
fmatvec::SymMat3 & | getInertiaTensor () |
|
void | addFrame (FixedRelativeFrame *frame) |
| void | addFrame (Frame *frame, const fmatvec::Vec3 &RrRF, const fmatvec::SqrMat3 &ARF, const Frame *refFrame=0) |
| void | addFrame (const std::string &str, const fmatvec::Vec3 &RrRF, const fmatvec::SqrMat3 &ARF, const Frame *refFrame=0) |
| void | addContour (Contour *contour, const fmatvec::Vec3 &RrRC, const fmatvec::SqrMat3 &ARC, const Frame *refFrame=0) |
| void | setFrameForKinematics (Frame *frame) |
|
virtual void | initializeUsingXML (MBXMLUtils::TiXmlElement *element) |
|
virtual MBXMLUtils::TiXmlElement * | writeXMLFile (MBXMLUtils::TiXmlNode *element) |
|
virtual void | updatePositionAndOrientationOfFrame (double t, Frame *P) |
|
virtual void | updateAccelerations (double t, Frame *P) |
|
virtual void | updateRelativeJacobians (double t, Frame *P) |
|
virtual void | updateRelativeJacobians (double t, Frame *P, fmatvec::Mat3xV &WJTrel, fmatvec::Mat3xV &WJRrel) |
|
const fmatvec::Mat3xV & | getWJTrel () const |
|
const fmatvec::Mat3xV & | getWJRrel () const |
|
fmatvec::Mat3xV & | getWJTrel () |
|
fmatvec::Mat3xV & | getWJRrel () |
|
fmatvec::Mat & | getJRel (int i=0) |
|
fmatvec::Vec & | getjRel () |
|
fmatvec::Vec & | getqRel () |
|
fmatvec::Vec & | getuRel () |
|
fmatvec::Mat3xV & | getPJT (int i=0) |
|
fmatvec::Mat3xV & | getPJR (int i=0) |
|
int | getqRelSize () const |
|
int | getuRelSize (int i=0) const |
Protected Member Functions |
|
void | updateMConst (double t, int i=0) |
| | update constant mass matrix
|
|
void | updateMNotConst (double t, int i=0) |
| | update time dependend mass matrix
|
|
void | facLLMConst (int i=0) |
| | Cholesky decomposition of constant mass matrix.
|
|
void | facLLMNotConst (int i=0) |
| | Cholesky decomposition of time dependent mass matrix.
|
Protected Attributes |
|
double | m |
| | mass
|
|
fmatvec::SymMat3 | SThetaS |
| | inertia tensor with respect to centre of gravity in centre of gravity and world Frame
|
|
fmatvec::SymMat3 | WThetaS |
|
FixedRelativeFrame * | K |
|
fmatvec::SymMat | Mbuf |
| | TODO.
|
|
bool | cb |
| | boolean to use body fixed Frame for rotation
|
|
fmatvec::Mat3xV | PJT [2] |
| | JACOBIAN of translation, rotation and their derivatives in parent system.
|
|
fmatvec::Mat3xV | PJR [2] |
|
fmatvec::Mat3xV | PdJT |
|
fmatvec::Mat3xV | PdJR |
|
fmatvec::Vec3 | PjT |
| | guiding velocities of translation, rotation and their derivatives in parent system
|
|
fmatvec::Vec3 | PjR |
|
fmatvec::Vec3 | PdjT |
|
fmatvec::Vec3 | PdjR |
|
fmatvec::SqrMat3 | APK |
| | rotation matrix from kinematic Frame to parent Frame
|
|
fmatvec::Vec3 | PrPK |
| | translation from parent to kinematic Frame in parent and world system
|
|
fmatvec::Vec3 | WrPK |
|
fmatvec::Vec3 | WvPKrel |
| | translational and angular velocity from parent to kinematic Frame in world system
|
|
fmatvec::Vec3 | WomPK |
|
TMatrix * | fT |
| | JACOBIAN for linear transformation between differentiated positions and velocities.
|
|
Translation * | fPrPK |
| | translation from parent Frame to kinematic Frame in parent system
|
|
Rotation * | fAPK |
| | rotation from kinematic Frame to parent Frame
|
|
Jacobian * | fPJT |
| | JACOBIAN of translation in parent system.
|
|
Jacobian * | fPJR |
| | JACOBIAN of rotation in parent system.
|
|
DerivativeOfJacobian * | fPdJT |
| | differentiated JACOBIAN of translation in parent system
|
|
DerivativeOfJacobian * | fPdJR |
| | differentiated JACOBIAN of rotation in parent system
|
|
GuidingVelocity * | fPjT |
| | guiding velocity of translation in parent system
|
|
GuidingVelocity * | fPjR |
| | guiding velocity of rotation in parent system
|
|
DerivativeOfGuidingVelocity * | fPdjT |
| | differentiated guiding veclocity of translation in parent system
|
|
DerivativeOfGuidingVelocity * | fPdjR |
| | differentiated guiding veclocity of rotation in parent system
|
|
void(RigidBody::* | updateM_ )(double t, int i) |
| | function pointer to update mass matrix
|
|
void(RigidBody::* | facLLM_ )(int i) |
| | function pointer for Cholesky decomposition of mass matrix
|
|
void(RigidBody::* | updateJacobians_ [2])(double t) |
|
FixedRelativeFrame * | C |
| | a pointer to Frame "C"
|
|
fmatvec::Vec | aT |
|
fmatvec::Vec | aR |
|
fmatvec::Vec | qRel |
|
fmatvec::Vec | uRel |
|
fmatvec::Mat | JRel [2] |
|
fmatvec::Vec | jRel |
|
fmatvec::Mat3xV | WJTrel |
|
fmatvec::Mat3xV | WJRrel |
|
fmatvec::Vec3 | WjTrel |
|
fmatvec::Vec3 | WjRrel |
|
fmatvec::Mat | TRel |
|
Constraint * | constraint |
|
int | nu [2] |
|
int | nq |
|
Frame * | frameForJacobianOfRotation |
|
std::vector< FixedRelativeFrame * > | RBF |
|
std::vector< CompoundContour * > | RBC |
|
Frame * | frameForInertiaTensor |
rigid bodies with arbitrary kinematics
- Author:
- Martin Foerg
- Date:
- 2009-04-08 some comments (Thorsten Schindler)
-
2009-07-16 splitted link / object right hand side (Thorsten Schindler)
-
2009-12-14 revised inverse kinetics (Martin Foerg)
-
2010-04-24 class can handle constraints on generalized coordinates (Martin Foerg)
-
2010-06-20 add getter for Kinematics; revision on doxygen comments (Roland Zander)
- Todo:
kinetic energy TODO
Euler parameter TODO
check if inertial system for performance TODO
rigid bodies have a predefined canonic Frame 'C' in their centre of gravity