#include <RBDyn/RBDyn/IS.h>
Public Member Functions | |
InverseStatics () | |
InverseStatics (const MultiBody &mb) | |
void | setJacobianSize (const MultiBody &mb, const MultiBodyConfig &mbc, const std::vector< Eigen::MatrixXd > &jacMomentsAndForces) |
void | inverseStatics (const MultiBody &mb, MultiBodyConfig &mbc) |
void | computeTorqueJacobianJoint (const MultiBody &mb, MultiBodyConfig &mbc, const std::vector< Eigen::MatrixXd > &jacMomentsAndForces) |
void | computeTorqueJacobianJoint (const MultiBody &mb, MultiBodyConfig &mbc) |
void | sInverseStatics (const MultiBody &mb, MultiBodyConfig &mbc) |
const std::vector< sva::ForceVecd > & | f () const |
Get the internal forces. More... | |
const std::vector< Eigen::MatrixXd > & | jointTorqueDiff () const |
Inverse Dynamics algorithm.
|
inline |
rbd::InverseStatics::InverseStatics | ( | const MultiBody & | mb | ) |
mb | MultiBody associated with this algorithm. |
void rbd::InverseStatics::computeTorqueJacobianJoint | ( | const MultiBody & | mb, |
MultiBodyConfig & | mbc | ||
) |
Default version of computeTorqeuJacobienJoint The external forces are assumed constant w.r.t q
void rbd::InverseStatics::computeTorqueJacobianJoint | ( | const MultiBody & | mb, |
MultiBodyConfig & | mbc, | ||
const std::vector< Eigen::MatrixXd > & | jacMomentsAndForces | ||
) |
Compute the derivatives of the torques calculated by the inverse statics w.r.t. q and forces WARNING: This computes the derivative of the torques w.r.t some fictitious forces applied on each body at the point (0,0,0) of the reference frame.
mb | MultiBody used has model. |
mbc | Uses force, parentToSon, bodyPosW, parentToSon, motionSubspace and gravity. |
jacMomentsAndForces | vector of jacobian of external forces on each body. It is assumed to be computed by the user. It is the jacobian of the equivalent force transported at the zero of the robot. Note that those matrix should be empty if zero to avoid unnecessary calculations. Fills jointTorqueJacQ and jointTorqueJacF. |
|
inline |
Get the internal forces.
void rbd::InverseStatics::inverseStatics | ( | const MultiBody & | mb, |
MultiBodyConfig & | mbc | ||
) |
Compute the inverse statics.
mb | MultiBody used has model. |
mbc | Uses force, parentToSon, bodyPosW, motionSubspace and gravity. Fills bodyAccB and jointTorque. |
|
inline |
void rbd::InverseStatics::setJacobianSize | ( | const MultiBody & | mb, |
const MultiBodyConfig & | mbc, | ||
const std::vector< Eigen::MatrixXd > & | jacMomentsAndForces | ||
) |
void rbd::InverseStatics::sInverseStatics | ( | const MultiBody & | mb, |
MultiBodyConfig & | mbc | ||
) |