Define a stack of contact models. More...

#include <multiple-contacts.hpp>

Public Types
typedef ContactDataAbstractTpl< Scalar >	ContactDataAbstract

typedef std::map< std::string, std::shared_ptr< ContactDataAbstract > >	ContactDataContainer

typedef ContactDataMultipleTpl< Scalar >	ContactDataMultiple

typedef ContactItemTpl< Scalar >	ContactItem

typedef ContactModelAbstractTpl< Scalar >	ContactModelAbstract

typedef std::map< std::string, std::shared_ptr< ContactItem > >	ContactModelContainer

typedef pinocchio::container::aligned_vector< pinocchio::ForceTpl< Scalar > >::iterator	ForceIterator

typedef MathBaseTpl< Scalar >	MathBase

typedef MathBase::MatrixXs	MatrixXs

typedef StateMultibodyTpl< Scalar >	StateMultibody

typedef MathBase::Vector2s	Vector2s

typedef MathBase::Vector3s	Vector3s

typedef MathBase::VectorXs	VectorXs

Public Member Functions
	ContactModelMultipleTpl (std::shared_ptr< StateMultibody > state)
	Initialize the multi-contact model. More...

	ContactModelMultipleTpl (std::shared_ptr< StateMultibody > state, const std::size_t nu)
	Initialize the multi-contact model. More...

void	addContact (const std::string &name, std::shared_ptr< ContactModelAbstract > contact, const bool active=true)
	Add contact item. More...

void	calc (const std::shared_ptr< ContactDataMultiple > &data, const Eigen::Ref< const VectorXs > &x)
	Compute the contact Jacobian and contact acceleration. More...

void	calcDiff (const std::shared_ptr< ContactDataMultiple > &data, const Eigen::Ref< const VectorXs > &x)
	Compute the derivatives of the contact holonomic constraint. More...

void	changeContactStatus (const std::string &name, const bool active)
	Change the contact status. More...

std::shared_ptr< ContactDataMultiple >	createData (pinocchio::DataTpl< Scalar > *const data)
	Create the multi-contact data. More...

const std::set< std::string > &	get_active_set () const
	Return the names of the set of active contacts.

const ContactModelContainer &	get_contacts () const
	Return the contact models.

const std::set< std::string > &	get_inactive_set () const
	Return the names of the set of inactive contacts.

std::size_t	get_nc () const
	Return the dimension of active contacts.

std::size_t	get_nc_total () const
	Return the dimension of all contacts.

std::size_t	get_nu () const
	Return the dimension of control vector.

const std::shared_ptr< StateMultibody > &	get_state () const
	Return the multibody state.

bool	getComputeAllContacts () const
	Return the type of contact computation. More...

bool	getContactStatus (const std::string &name) const
	Return the status of a given contact name.

void	removeContact (const std::string &name)
	Remove contact item. More...

void	setComputeAllContacts (const bool status)
	Set the tyoe of contact computation: all or active contacts. More...

void	updateAcceleration (const std::shared_ptr< ContactDataMultiple > &data, const VectorXs &dv) const
	Update the constrained system acceleration. More...

void	updateAccelerationDiff (const std::shared_ptr< ContactDataMultiple > &data, const MatrixXs &ddv_dx) const
	Update the Jacobian of the constrained system acceleration. More...

void	updateForce (const std::shared_ptr< ContactDataMultiple > &data, const VectorXs &force)
	Update the spatial force defined in frame coordinate. More...

void	updateForceDiff (const std::shared_ptr< ContactDataMultiple > &data, const MatrixXs &df_dx, const MatrixXs &df_du) const
	Update the Jacobian of the spatial force defined in frame coordinate. More...

void	updateRneaDiff (const std::shared_ptr< ContactDataMultiple > &data, pinocchio::DataTpl< Scalar > &pinocchio) const
	Update the RNEA derivatives dtau_dq by adding the skew term (necessary for contacts expressed in LOCAL_WORLD_ALIGNED / WORLD) More...

Public Attributes
EIGEN_MAKE_ALIGNED_OPERATOR_NEW typedef _Scalar	Scalar

Friends
template<class Scalar >
std::ostream &	operator<< (std::ostream &os, const ContactModelMultipleTpl< Scalar > &model)
	Print information on the contact models.

Detailed Description

template<typename _Scalar>
class crocoddyl::ContactModelMultipleTpl< _Scalar >

Define a stack of contact models.

The contact models can be defined with active and inactive status. The idea behind this design choice is to be able to create a mechanism that allocates the entire data needed for the computations. Then, there are designed routines that update the only active contacts.

Definition at line 60 of file multiple-contacts.hpp.

Constructor & Destructor Documentation

◆ ContactModelMultipleTpl() [1/2]

ContactModelMultipleTpl	(	std::shared_ptr< StateMultibody >	state,
		const std::size_t	nu
	)

Initialize the multi-contact model.

Parameters

[in]	state	Multibody state
[in]	nu	Dimension of control vector

◆ ContactModelMultipleTpl() [2/2]

ContactModelMultipleTpl ( std::shared_ptr< StateMultibody > state )

Initialize the multi-contact model.

Parameters

[in] state Multibody state

Member Function Documentation

◆ addContact()

void addContact	(	const std::string &	name,
		std::shared_ptr< ContactModelAbstract >	contact,
		const bool	active = `true`
	)

Add contact item.

Note that the memory is allocated for inactive contacts as well.

Parameters

[in]	name	Contact name
[in]	contact	Contact model
[in]	active	Contact status (active by default)

◆ removeContact()

void removeContact ( const std::string & name )

Remove contact item.

Parameters

[in] name Contact name

◆ changeContactStatus()

void changeContactStatus	(	const std::string &	name,
		const bool	active
	)

Change the contact status.

Parameters

[in]	name	Contact name
[in]	active	Contact status (True for active)

◆ calc()

void calc	(	const std::shared_ptr< ContactDataMultiple > &	data,
		const Eigen::Ref< const VectorXs > &	x
	)

Compute the contact Jacobian and contact acceleration.

Parameters

[in]	data	Multi-contact data
[in]	x	State point \(\mathbf{x}\in\mathbb{R}^{ndx}\)

◆ calcDiff()

void calcDiff	(	const std::shared_ptr< ContactDataMultiple > &	data,
		const Eigen::Ref< const VectorXs > &	x
	)

Compute the derivatives of the contact holonomic constraint.

Parameters

[in]	data	Multi-contact data
[in]	x	State point \(\mathbf{x}\in\mathbb{R}^{ndx}\)

◆ updateAcceleration()

void updateAcceleration	(	const std::shared_ptr< ContactDataMultiple > &	data,
		const VectorXs &	dv
	)		const

Update the constrained system acceleration.

Parameters

[in]	data	Multi-contact data
[in]	dv	Constrained system acceleration \(\dot{\mathbf{v}}\in\mathbb{R}^{nv}\)

◆ updateForce()

void updateForce	(	const std::shared_ptr< ContactDataMultiple > &	data,
		const VectorXs &	force
	)

Update the spatial force defined in frame coordinate.

Parameters

[in]	data	Multi-contact data
[in]	force	Spatial force defined in frame coordinate \({}^o\underline{\boldsymbol{\lambda}}_c\in\mathbb{R}^{nc}\)

◆ updateAccelerationDiff()

void updateAccelerationDiff	(	const std::shared_ptr< ContactDataMultiple > &	data,
		const MatrixXs &	ddv_dx
	)		const

Update the Jacobian of the constrained system acceleration.

Parameters

[in]	data	Multi-contact data
[in]	ddv_dx	Jacobian of the system acceleration in generalized coordinates \(\frac{\partial\dot{\mathbf{v}}}{\partial\mathbf{x}}\in\mathbb{R}^{nv\times ndx}\)

◆ updateForceDiff()

void updateForceDiff	(	const std::shared_ptr< ContactDataMultiple > &	data,
		const MatrixXs &	df_dx,
		const MatrixXs &	df_du
	)		const

Update the Jacobian of the spatial force defined in frame coordinate.

Parameters

[in]	data	Multi-contact data
[in]	df_dx	Jacobian of the spatial impulse defined in frame coordinate \(\frac{\partial{}^o\underline{\boldsymbol{\lambda}}_c}{\partial\mathbf{x}}\in\mathbb{R}^{nc\times{ndx}}\)
[in]	df_du	Jacobian of the spatial impulse defined in frame coordinate \(\frac{\partial{}^o\underline{\boldsymbol{\lambda}}_c}{\partial\mathbf{u}}\in\mathbb{R}^{nc\times{nu}}\)

◆ updateRneaDiff()

void updateRneaDiff	(	const std::shared_ptr< ContactDataMultiple > &	data,
		pinocchio::DataTpl< Scalar > &	pinocchio
	)		const

Update the RNEA derivatives dtau_dq by adding the skew term (necessary for contacts expressed in LOCAL_WORLD_ALIGNED / WORLD)

To learn more about the computation of the contact derivatives in different frames see https://hal.science/hal-03758989/document.

Parameters

[in]	data	Multi-contact data
[in]	pinocchio	Pinocchio data

◆ createData()

std::shared_ptr<ContactDataMultiple> createData ( pinocchio::DataTpl< Scalar > *const data )

Create the multi-contact data.

Parameters

[in] data Pinocchio data

Returns: the multi-contact data.

◆ getComputeAllContacts()

bool getComputeAllContacts ( ) const

Return the type of contact computation.

True for all contacts, otherwise false for active contacts

◆ setComputeAllContacts()

void setComputeAllContacts ( const bool status )

Set the tyoe of contact computation: all or active contacts.

Parameters

status Type of contact computation (true for all contacts and false for active contacts)

The documentation for this class was generated from the following file:

/root/robotpkg/optimization/py-crocoddyl/work/crocoddyl-2.1.0/include/crocoddyl/multibody/contacts/multiple-contacts.hpp

Public Types

Public Member Functions

Public Attributes

Friends

Detailed Description

template<typename _Scalar> class crocoddyl::ContactModelMultipleTpl< _Scalar >

Constructor & Destructor Documentation

◆ ContactModelMultipleTpl() [1/2]

◆ ContactModelMultipleTpl() [2/2]

Member Function Documentation

◆ addContact()

◆ removeContact()

◆ changeContactStatus()

◆ calc()

◆ calcDiff()

◆ updateAcceleration()

◆ updateForce()

◆ updateAccelerationDiff()

◆ updateForceDiff()

◆ updateRneaDiff()

◆ createData()

◆ getComputeAllContacts()

◆ setComputeAllContacts()

template<typename _Scalar>
class crocoddyl::ContactModelMultipleTpl< _Scalar >