#include <sobec/crocomplements/contact/contact3d.hpp>
Public Types | |
typedef crocoddyl::MathBaseTpl< Scalar > | MathBase |
typedef crocoddyl::ContactModel3DTpl< Scalar > | Base |
typedef ContactData3DTpl< Scalar > | Data |
typedef crocoddyl::StateMultibodyTpl< Scalar > | StateMultibody |
typedef MathBase::Vector2s | Vector2s |
typedef MathBase::Vector3s | Vector3s |
typedef MathBase::VectorXs | VectorXs |
Public Member Functions | |
ContactModel3DTpl (boost::shared_ptr< StateMultibody > state, const pinocchio::FrameIndex id, const Vector3s &xref, const std::size_t nu, const Vector2s &gains=Vector2s::Zero(), const pinocchio::ReferenceFrame type=pinocchio::LOCAL) | |
Initialize the 3d contact model. More... | |
ContactModel3DTpl (boost::shared_ptr< StateMultibody > state, const pinocchio::FrameIndex id, const Vector3s &xref, const Vector2s &gains=Vector2s::Zero(), const pinocchio::ReferenceFrame type=pinocchio::LOCAL) | |
Initialize the 3d contact model. More... | |
virtual | ~ContactModel3DTpl () |
virtual void | calc (const boost::shared_ptr< crocoddyl::ContactDataAbstractTpl< Scalar >> &data, const Eigen::Ref< const VectorXs > &x) |
Compute the 3d contact Jacobian and drift. More... | |
virtual void | calcDiff (const boost::shared_ptr< crocoddyl::ContactDataAbstractTpl< Scalar >> &data, const Eigen::Ref< const VectorXs > &x) |
Compute the derivatives of the 3d contact holonomic constraint. More... | |
virtual void | updateForce (const boost::shared_ptr< crocoddyl::ContactDataAbstractTpl< Scalar >> &data, const VectorXs &force) |
Convert the force into a stack of spatial forces. More... | |
virtual boost::shared_ptr< crocoddyl::ContactDataAbstractTpl< Scalar > > | createData (pinocchio::DataTpl< Scalar > *const data) |
Create the 3d contact data. More... | |
const Vector3s & | get_reference () const |
Return the reference frame translation. More... | |
const Vector2s & | get_gains () const |
Return the Baumgarte stabilization gains. More... | |
void | set_reference (const Vector3s &reference) |
Modify the reference frame translation. More... | |
void | set_type (const pinocchio::ReferenceFrame type) |
Modify pinocchio::ReferenceFrame. More... | |
const pinocchio::ReferenceFrame & | get_type () const |
Get pinocchio::ReferenceFrame. More... | |
virtual void | print (std::ostream &os) const |
Print relevant information of the 3d contact model. More... | |
Public Attributes | |
EIGEN_MAKE_ALIGNED_OPERATOR_NEW typedef _Scalar | Scalar |
typedef crocoddyl::ContactModel3DTpl<Scalar> sobec::newcontacts::ContactModel3DTpl< _Scalar >::Base |
typedef ContactData3DTpl<Scalar> sobec::newcontacts::ContactModel3DTpl< _Scalar >::Data |
typedef crocoddyl::MathBaseTpl<Scalar> sobec::newcontacts::ContactModel3DTpl< _Scalar >::MathBase |
typedef crocoddyl::StateMultibodyTpl<Scalar> sobec::newcontacts::ContactModel3DTpl< _Scalar >::StateMultibody |
typedef MathBase::Vector2s sobec::newcontacts::ContactModel3DTpl< _Scalar >::Vector2s |
typedef MathBase::Vector3s sobec::newcontacts::ContactModel3DTpl< _Scalar >::Vector3s |
typedef MathBase::VectorXs sobec::newcontacts::ContactModel3DTpl< _Scalar >::VectorXs |
sobec::newcontacts::ContactModel3DTpl< Scalar >::ContactModel3DTpl | ( | boost::shared_ptr< StateMultibody > | state, |
const pinocchio::FrameIndex | id, | ||
const Vector3s & | xref, | ||
const std::size_t | nu, | ||
const Vector2s & | gains = Vector2s::Zero() , |
||
const pinocchio::ReferenceFrame | type = pinocchio::LOCAL |
||
) |
Initialize the 3d contact model.
[in] | state | State of the multibody system |
[in] | id | Reference frame id of the contact |
[in] | xref | Contact position used for the Baumgarte stabilization |
[in] | nu | Dimension of the control vector |
[in] | gains | Baumgarte stabilization gains |
sobec::newcontacts::ContactModel3DTpl< Scalar >::ContactModel3DTpl | ( | boost::shared_ptr< StateMultibody > | state, |
const pinocchio::FrameIndex | id, | ||
const Vector3s & | xref, | ||
const Vector2s & | gains = Vector2s::Zero() , |
||
const pinocchio::ReferenceFrame | type = pinocchio::LOCAL |
||
) |
Initialize the 3d contact model.
The default nu
is obtained from StateAbstractTpl::get_nv()
.
[in] | state | State of the multibody system |
[in] | id | Reference frame id of the contact |
[in] | xref | Contact position used for the Baumgarte stabilization |
[in] | gains | Baumgarte stabilization gains |
|
virtual |
|
virtual |
Compute the 3d contact Jacobian and drift.
[in] | data | 3d contact data |
[in] | x | State point \(\mathbf{x}\in\mathbb{R}^{ndx}\) |
[in] | u | Control input \(\mathbf{u}\in\mathbb{R}^{nu}\) |
|
virtual |
Compute the derivatives of the 3d contact holonomic constraint.
[in] | data | 3d contact data |
[in] | x | State point \(\mathbf{x}\in\mathbb{R}^{ndx}\) |
[in] | u | Control input \(\mathbf{u}\in\mathbb{R}^{nu}\) |
|
virtual |
Create the 3d contact data.
const crocoddyl::MathBaseTpl< Scalar >::Vector2s & sobec::newcontacts::ContactModel3DTpl< Scalar >::get_gains |
Return the Baumgarte stabilization gains.
const crocoddyl::MathBaseTpl< Scalar >::Vector3s & sobec::newcontacts::ContactModel3DTpl< Scalar >::get_reference |
Return the reference frame translation.
const pinocchio::ReferenceFrame & sobec::newcontacts::ContactModel3DTpl< Scalar >::get_type |
Get pinocchio::ReferenceFrame.
|
virtual |
Print relevant information of the 3d contact model.
[out] | os | Output stream object |
void sobec::newcontacts::ContactModel3DTpl< Scalar >::set_reference | ( | const Vector3s & | reference | ) |
Modify the reference frame translation.
void sobec::newcontacts::ContactModel3DTpl< Scalar >::set_type | ( | const pinocchio::ReferenceFrame | type | ) |
Modify pinocchio::ReferenceFrame.
|
virtual |
Convert the force into a stack of spatial forces.
[in] | data | 3d contact data |
[in] | force | 3d force |
EIGEN_MAKE_ALIGNED_OPERATOR_NEW typedef _Scalar sobec::newcontacts::ContactModel3DTpl< _Scalar >::Scalar |