#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 | ||
| ) |