|
Choreonoid
1.5
|
#include <ForwardDynamics.h>
Public Member Functions | |
| ForwardDynamics (DyBody *body) | |
| virtual | ~ForwardDynamics () |
| void | setGravityAcceleration (const Vector3 &g) |
| void | setEulerMethod () |
| void | setRungeKuttaMethod () |
| void | setTimeStep (double timeStep) |
| void | enableSensors (bool on) |
| void | setOldAccelSensorCalcMode (bool on) |
| virtual void | initialize ()=0 |
| virtual void | calcNextState ()=0 |
Public Attributes | |
| EIGEN_MAKE_ALIGNED_OPERATOR_NEW | |
Protected Types | |
| enum | { EULER_METHOD, RUNGEKUTTA_METHOD } |
Protected Member Functions | |
| virtual void | initializeSensors () |
Static Protected Member Functions | |
| static void | SE3exp (Position &out_T, const Position &T0, const Vector3 &w, const Vector3 &vo, double dt) |
| update position/orientation using spatial velocity More... | |
Protected Attributes | |
| DyBodyPtr | body |
| Vector3 | g |
| double | timeStep |
| bool | sensorsEnabled |
| BasicSensorSimulationHelper | sensorHelper |
| enum cnoid::ForwardDynamics:: { ... } | integrationMode |
This class calculates the forward dynamics of a Body object by using the Featherstone's articulated body algorithm. The class also integrates motion using the Euler method or RungeKutta method.
| ForwardDynamics::ForwardDynamics | ( | DyBody * | body | ) |
|
virtual |
|
pure virtual |
Implemented in cnoid::ForwardDynamicsCBM, and cnoid::ForwardDynamicsABM.
| void ForwardDynamics::enableSensors | ( | bool | on | ) |
|
pure virtual |
Implemented in cnoid::ForwardDynamicsCBM, and cnoid::ForwardDynamicsABM.
|
protectedvirtual |
|
staticprotected |
update position/orientation using spatial velocity
function from Murray, Li and Sastry p.42
| out_p | p(t+dt) |
| out_R | R(t+dt) |
| p0 | p(t) |
| R0 | R(t) |
| w | angular velocity |
| v0 | spatial velocity |
| dt | time step[s] |
| void ForwardDynamics::setEulerMethod | ( | ) |
| void ForwardDynamics::setGravityAcceleration | ( | const Vector3 & | g | ) |
| void ForwardDynamics::setOldAccelSensorCalcMode | ( | bool | on | ) |
| void ForwardDynamics::setRungeKuttaMethod | ( | ) |
| void ForwardDynamics::setTimeStep | ( | double | timeStep | ) |
|
protected |
| cnoid::ForwardDynamics::EIGEN_MAKE_ALIGNED_OPERATOR_NEW |
|
protected |
| enum { ... } cnoid::ForwardDynamics::integrationMode |
|
protected |
|
protected |
|
protected |
1.8.13