#include <RBDyn/RBDyn/FD.h>
Public Member Functions | |
ForwardDynamics () | |
ForwardDynamics (const MultiBody &mb) | |
void | forwardDynamics (const MultiBody &mb, MultiBodyConfig &mbc) |
void | computeH (const MultiBody &mb, const MultiBodyConfig &mbc) |
void | computeC (const MultiBody &mb, const MultiBodyConfig &mbc) |
const Eigen::MatrixXd & | H () const |
const Eigen::VectorXd & | C () const |
const std::vector< sva::RBInertiad > & | inertiaSubTree () const |
void | sForwardDynamics (const MultiBody &mb, MultiBodyConfig &mbc) |
void | sComputeH (const MultiBody &mb, const MultiBodyConfig &mbc) |
void | sComputeC (const MultiBody &mb, const MultiBodyConfig &mbc) |
Forward Dynamics algorithm.
|
inline |
rbd::ForwardDynamics::ForwardDynamics | ( | const MultiBody & | mb | ) |
mb | MultiBody associated with this algorithm. |
|
inline |
void rbd::ForwardDynamics::computeC | ( | const MultiBody & | mb, |
const MultiBodyConfig & | mbc | ||
) |
Compute the non linear effect vector (coriolis, gravity, external force).
mb | MultiBody used has model. |
mbc | Use parentToSon, motionSubspace jointVelocity, bodyVelB, bodyPosW, force and gravity. |
void rbd::ForwardDynamics::computeH | ( | const MultiBody & | mb, |
const MultiBodyConfig & | mbc | ||
) |
Compute the inertia matrix H.
mb | MultiBody used has model. |
mbc | Use parentToSon and motionSubspace. |
void rbd::ForwardDynamics::forwardDynamics | ( | const MultiBody & | mb, |
MultiBodyConfig & | mbc | ||
) |
Compute the forward dynamics.
mb | MultiBody used has model. |
mbc | Use parentToSon, motionSubspace jointVelocity, bodyVelB, bodyPosW, force, gravity and jointTorque. Fill alphaD generalized acceleration vector. |
|
inline |
|
inline |
void rbd::ForwardDynamics::sComputeC | ( | const MultiBody & | mb, |
const MultiBodyConfig & | mbc | ||
) |
void rbd::ForwardDynamics::sComputeH | ( | const MultiBody & | mb, |
const MultiBodyConfig & | mbc | ||
) |
void rbd::ForwardDynamics::sForwardDynamics | ( | const MultiBody & | mb, |
MultiBodyConfig & | mbc | ||
) |