![]() |
- 3.0.2 rigid body dynamics module.
|
joint states and base states More...
#include <RBDState.h>
Public Types | |
| using | RigidBodyState_t = tpl::RigidBodyState< SCALAR > |
| using | RigidBodyPose_t = tpl::RigidBodyPose< SCALAR > |
| typedef ct::core::StateVector< NSTATE_QUAT, SCALAR > | state_vector_quat_t |
| typedef ct::core::StateVector< NSTATE, SCALAR > | state_vector_euler_t |
| typedef ct::core::StateVector< NDOF, SCALAR > | coordinate_vector_t |
Public Member Functions | |
| RBDState (typename RigidBodyPose_t::STORAGE_TYPE storage=RigidBodyPose_t::EULER) | |
| RBDState (const RBDState &other) | |
| RBDState (const RigidBodyState_t &baseState, const JointState< NJOINTS, SCALAR > &jointState) | |
| virtual | ~RBDState ()=default |
| bool | operator!= (const RBDState &other) const |
| bool | isApprox (const RBDState &rhs, const SCALAR &tol=1e-10) |
| RigidBodyState_t & | base () |
| get base states More... | |
| const RigidBodyState_t & | base () const |
| get constant base states More... | |
| RigidBodyPose_t & | basePose () |
| get base pose More... | |
| const RigidBodyPose_t & | basePose () const |
| get constant base states More... | |
| tpl::RigidBodyVelocities< SCALAR > & | baseVelocities () |
| get base velocities More... | |
| const tpl::RigidBodyVelocities< SCALAR > & | baseVelocities () const |
| get constant base velocities More... | |
| kindr::LocalAngularVelocity< SCALAR > & | baseLocalAngularVelocity () |
| get base local angular velocity More... | |
| const kindr::LocalAngularVelocity< SCALAR > & | baseLocalAngularVelocity () const |
| get constant base local angular velocity More... | |
| kindr::Velocity< SCALAR, 3 > & | baseLinearVelocity () |
| get base linear velocity More... | |
| const kindr::Velocity< SCALAR, 3 > & | baseLinearVelocity () const |
| get constant base local angular velocity More... | |
| JointState< NJOINTS, SCALAR > & | joints () |
| get joint states More... | |
| const JointState< NJOINTS, SCALAR > & | joints () const |
| get constant joint states More... | |
| JointState< NJOINTS, SCALAR >::JointPositionBlock | jointPositions () |
| get joint positions More... | |
| const JointState< NJOINTS, SCALAR >::JointPositionBlockConst | jointPositions () const |
| get constant joint positions More... | |
| JointState< NJOINTS, SCALAR >::JointPositionBlock | jointVelocities () |
| get joint velocities More... | |
| const JointState< NJOINTS, SCALAR >::JointPositionBlockConst | jointVelocities () const |
| get constant joint velocities More... | |
| state_vector_quat_t | toStateVectorQuaternion () const |
| coordinate_vector_t | toCoordinatePositionUnique () const |
| coordinate_vector_t | toCoordinatePosition () const |
| coordinate_vector_t | toCoordinateVelocity () const |
| state_vector_euler_t | toStateVectorEulerXyzUnique () const |
| state_vector_euler_t | toStateVectorEulerXyz () const |
| void | fromStateVectorQuaternion (const state_vector_quat_t &state) |
| void | fromStateVectorEulerXyz (const state_vector_euler_t &state) |
| void | fromStateVectorRaw (const state_vector_quat_t &state) |
| void | fromStateVectorRaw (const state_vector_euler_t &state) |
| virtual void | setDefault () |
| void | setZero () |
| void | setRandom () |
Static Public Attributes | |
| static EIGEN_MAKE_ALIGNED_OPERATOR_NEW const size_t | NDOF = NJOINTS + 6 |
| static const size_t | NSTATE = 2 * (NJOINTS + 6) |
| static const size_t | NSTATE_QUAT = NSTATE + 1 |
Protected Attributes | |
| RigidBodyState_t | baseState_ |
| JointState< NJOINTS, SCALAR > | jointState_ |
joint states and base states
| using ct::rbd::RBDState< NJOINTS, SCALAR >::RigidBodyState_t = tpl::RigidBodyState<SCALAR> |
| using ct::rbd::RBDState< NJOINTS, SCALAR >::RigidBodyPose_t = tpl::RigidBodyPose<SCALAR> |
| typedef ct::core::StateVector<NSTATE_QUAT, SCALAR> ct::rbd::RBDState< NJOINTS, SCALAR >::state_vector_quat_t |
| typedef ct::core::StateVector<NSTATE, SCALAR> ct::rbd::RBDState< NJOINTS, SCALAR >::state_vector_euler_t |
| typedef ct::core::StateVector<NDOF, SCALAR> ct::rbd::RBDState< NJOINTS, SCALAR >::coordinate_vector_t |
|
inline |
|
inline |
|
inline |
|
virtualdefault |
Referenced by ct::rbd::RBDState< NJOINTS, Scalar >::RBDState().
|
inline |
|
inline |
Referenced by TEST().
|
inline |
get base states
Referenced by ct::rbd::RBDState< NJOINTS, Scalar >::baseLinearVelocity(), ct::rbd::RBDState< NJOINTS, Scalar >::baseLocalAngularVelocity(), ct::rbd::RBDState< NJOINTS, Scalar >::basePose(), ct::rbd::RBDState< NJOINTS, Scalar >::baseVelocities(), ct::rbd::IDControllerFB< Dynamics >::computeDesiredAcceleration(), ct::rbd::RBDState< NJOINTS, Scalar >::fromStateVectorEulerXyz(), ct::rbd::RBDState< NJOINTS, Scalar >::fromStateVectorQuaternion(), ct::rbd::Kinematics< RBD, NEE >::getEEVelocityInBase(), ct::rbd::Kinematics< RBD, NEE >::getEEVelocityInWorld(), ct::rbd::RBDState< NJOINTS, Scalar >::isApprox(), ct::rbd::RBDState< NJOINTS, Scalar >::operator!=(), testFunctionRBDState(), ct::rbd::RBDState< NJOINTS, Scalar >::toCoordinatePosition(), ct::rbd::RBDState< NJOINTS, Scalar >::toCoordinatePositionUnique(), ct::rbd::RBDState< NJOINTS, Scalar >::toCoordinateVelocity(), ct::rbd::RBDAcceleration< NJOINTS, SCALAR >::toStateUpdateVectorEulerXyz(), ct::rbd::RBDAcceleration< NJOINTS, SCALAR >::toStateUpdateVectorQuaternion(), and ct::rbd::RBDState< NJOINTS, Scalar >::toStateVectorQuaternion().
|
inline |
get constant base states
|
inline |
get base pose
Referenced by ct::rbd::EEContactModel< Kinematics >::computeContactForces(), ct::rbd::IDControllerFB< Dynamics >::computeDesiredAcceleration(), ct::rbd::TermTaskspaceGeometricJacobian< KINEMATICS, STATE_DIM, CONTROL_DIM >::evaluate(), ct::rbd::Dynamics< RBD, NEE >::FloatingBaseForwardDynamics(), ct::rbd::Dynamics< RBD, NEE >::FloatingBaseFullyActuatedID(), ct::rbd::Dynamics< RBD, NEE >::FloatingBaseID(), ct::rbd::ProjectedDynamics< RBD, NEE >::ProjectedDynamics(), ct::rbd::FixBaseRobotState< NJOINTS, ACT_STATE_DIM, SCALAR >::rbdStateFromVector(), ct::rbd::TermTaskspaceGeometricJacobian< KINEMATICS, STATE_DIM, CONTROL_DIM >::stateDerivative(), TEST(), ct::rbd::FixBaseRobotState< NJOINTS, ACT_STATE_DIM, SCALAR >::toRBDState(), ct::rbd::RBDAcceleration< NJOINTS, SCALAR >::toStateUpdateVectorEulerXyz(), ct::rbd::RBDAcceleration< NJOINTS, SCALAR >::toStateUpdateVectorQuaternion(), and ct::rbd::tpl::OperationalModelRBD< RBDContainer, NUM_CONTACTPOINTS, SCALAR >::update().
|
inline |
get constant base states
|
inline |
|
inline |
get constant base velocities
|
inline |
get base local angular velocity
Referenced by ct::rbd::ProjectedDynamics< RBD, NEE >::ProjectedDynamics(), TEST(), ct::rbd::RBDAcceleration< NJOINTS, SCALAR >::toStateUpdateVectorEulerXyz(), ct::rbd::RBDAcceleration< NJOINTS, SCALAR >::toStateUpdateVectorQuaternion(), and ct::rbd::tpl::OperationalModelRBD< RBDContainer, NUM_CONTACTPOINTS, SCALAR >::update().
|
inline |
get constant base local angular velocity
|
inline |
get base linear velocity
Referenced by TEST(), and ct::rbd::tpl::OperationalModelRBD< RBDContainer, NUM_CONTACTPOINTS, SCALAR >::update().
|
inline |
get constant base local angular velocity
|
inline |
get joint states
Referenced by ct::rbd::WholeBodyController< NJOINTS >::computeControl(), ct::rbd::Dynamics< RBD, NEE >::FloatingBaseForwardDynamics(), ct::rbd::Dynamics< RBD, NEE >::FloatingBaseFullyActuatedID(), ct::rbd::Dynamics< RBD, NEE >::FloatingBaseID(), ct::rbd::RBDState< NJOINTS, Scalar >::fromStateVectorEulerXyz(), ct::rbd::RBDState< NJOINTS, Scalar >::fromStateVectorQuaternion(), ct::rbd::RBDState< NJOINTS, Scalar >::isApprox(), ct::rbd::RBDState< NJOINTS, Scalar >::jointPositions(), ct::rbd::RBDState< NJOINTS, Scalar >::jointVelocities(), ct::rbd::RBDState< NJOINTS, Scalar >::operator!=(), ct::rbd::ProjectedDynamics< RBD, NEE >::ProjectedDynamics(), ct::rbd::FixBaseRobotState< NJOINTS, ACT_STATE_DIM, SCALAR >::rbdStateFromVector(), testFunctionRBDState(), ct::rbd::RBDState< NJOINTS, Scalar >::toCoordinatePosition(), ct::rbd::RBDState< NJOINTS, Scalar >::toCoordinatePositionUnique(), ct::rbd::RBDState< NJOINTS, Scalar >::toCoordinateVelocity(), ct::rbd::FixBaseRobotState< NJOINTS, ACT_STATE_DIM, SCALAR >::toRBDState(), ct::rbd::RBDAcceleration< NJOINTS, SCALAR >::toStateUpdateVectorEulerXyz(), ct::rbd::RBDAcceleration< NJOINTS, SCALAR >::toStateUpdateVectorQuaternion(), and ct::rbd::RBDState< NJOINTS, Scalar >::toStateVectorQuaternion().
|
inline |
get constant joint states
|
inline |
get joint positions
Referenced by ct::rbd::EEContactModel< Kinematics >::computeContactForces(), ct::rbd::TermTaskspaceGeometricJacobian< KINEMATICS, STATE_DIM, CONTROL_DIM >::evaluate(), ct::rbd::Kinematics< RBD, NEE >::getEEVelocityInBase(), ct::rbd::Kinematics< RBD, NEE >::getJacobianBaseEEbyId(), ct::rbd::TermTaskspaceGeometricJacobian< KINEMATICS, STATE_DIM, CONTROL_DIM >::stateDerivative(), ct::rbd::TermTaskspaceGeometricJacobian< KINEMATICS, STATE_DIM, CONTROL_DIM >::stateSecondDerivative(), TEST(), and ct::rbd::tpl::OperationalModelRBD< RBDContainer, NUM_CONTACTPOINTS, SCALAR >::update().
|
inline |
get constant joint positions
|
inline |
get joint velocities
Referenced by ct::rbd::Kinematics< RBD, NEE >::getEEVelocityInBase(), TEST(), and ct::rbd::tpl::OperationalModelRBD< RBDContainer, NUM_CONTACTPOINTS, SCALAR >::update().
|
inline |
get constant joint velocities
|
inline |
|
inline |
|
inline |
|
inline |
Referenced by ct::rbd::OperationalModelBase< RBDContainer::NJOINTS+6, RBDContainer::NJOINTS, NUM_CONTACTPOINTS >::getAccelerations(), ct::rbd::OperationalModelBase< RBDContainer::NJOINTS+6, RBDContainer::NJOINTS, NUM_CONTACTPOINTS >::getVelocities(), ct::rbd::ProjectedDynamics< RBD, NEE >::ProjectedDynamics(), ct::rbd::RBDState< NJOINTS, Scalar >::toStateVectorEulerXyz(), ct::rbd::RBDState< NJOINTS, Scalar >::toStateVectorEulerXyzUnique(), and ct::rbd::OperationalModel< NUM_OUTPUTS, NUM_JOINTS, NUM_CONTACTPOINTS >::update().
|
inline |
|
inline |
|
inline |
|
inline |
|
inline |
|
inline |
|
inlinevirtual |
|
inline |
|
inline |
Referenced by TEST().
|
static |
|
static |
|
static |
|
protected |
|
protected |