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