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