Nonlinear centroidal forward dynamics with smooth control. More...

#include <aligator/modelling/dynamics/continuous-centroidal-fwd.hpp>

Inheritance diagram for aligator::dynamics::ContinuousCentroidalFwdDynamicsTpl< Scalar >:

Collaboration diagram for aligator::dynamics::ContinuousCentroidalFwdDynamicsTpl< Scalar >:

Public Types
using	Scalar = _Scalar

using	Base = ODEAbstractTpl<Scalar>

using	BaseData = ContinuousDynamicsDataTpl<Scalar>

using	ContDataAbstract = ContinuousDynamicsDataTpl<Scalar>

using	Data = ContinuousCentroidalFwdDataTpl<Scalar>

using	Manifold = proxsuite::nlp::VectorSpaceTpl<Scalar>

using	Matrix3s = Eigen::Matrix<Scalar, 3, 3>

using	ContactMap = ContactMapTpl<Scalar>

Public Types inherited from aligator::dynamics::ODEAbstractTpl< _Scalar >
using	Scalar = _Scalar

using	Base = ContinuousDynamicsAbstractTpl<Scalar>

using	Data = ContinuousDynamicsDataTpl<Scalar>

Public Types inherited from aligator::dynamics::ContinuousDynamicsAbstractTpl< _Scalar >
using	Scalar

using	Manifold

using	ManifoldPtr

using	Data

Public Member Functions
	ALIGATOR_DYNAMIC_TYPEDEFS (Scalar)

const Manifold &	space () const

	ContinuousCentroidalFwdDynamicsTpl (const Manifold &state, const double mass, const Vector3s &gravity, const ContactMap &contact_map, const int force_size)

void	forward (const ConstVectorRef &x, const ConstVectorRef &u, BaseData &data) const
	Evaluate the ODE vector field: this returns the value of \(\dot{x}\).

void	dForward (const ConstVectorRef &x, const ConstVectorRef &, BaseData &data) const
	Evaluate the vector field Jacobians.

shared_ptr< ContDataAbstract >	createData () const
	Create a data holder instance.

Public Member Functions inherited from aligator::dynamics::ODEAbstractTpl< _Scalar >
	ALIGATOR_DYNAMIC_TYPEDEFS (Scalar)

virtual	~ODEAbstractTpl ()=default

void	evaluate (const ConstVectorRef &x, const ConstVectorRef &u, const ConstVectorRef &xdot, Data &data) const override

void	computeJacobians (const ConstVectorRef &x, const ConstVectorRef &u, const ConstVectorRef &xdot, Data &data) const override

Public Member Functions inherited from aligator::dynamics::ContinuousDynamicsAbstractTpl< _Scalar >
	ALIGATOR_DYNAMIC_TYPEDEFS (_Scalar)

int	ndx () const

int	nu () const

const Manifold &	space () const
	Return a reference to the state space.

	ContinuousDynamicsAbstractTpl (ManifoldPtr space, const int nu)

virtual	~ContinuousDynamicsAbstractTpl ()=default

virtual void	evaluate (const ConstVectorRef &x, const ConstVectorRef &u, const ConstVectorRef &xdot, Data &data) const=0
	Evaluate the vector field at a point \((x, u)\).

virtual void	computeJacobians (const ConstVectorRef &x, const ConstVectorRef &u, const ConstVectorRef &xdot, Data &data) const=0
	Differentiate the vector field.

Public Attributes
Manifold	space_

std::size_t	nk_

double	mass_

Vector3s	gravity_

ContactMap	contact_map_

int	force_size_

Public Attributes inherited from aligator::dynamics::ODEAbstractTpl< _Scalar >
const int	nu_
	Control space dimension.

ManifoldPtr	space_
	State space.

Public Attributes inherited from aligator::dynamics::ContinuousDynamicsAbstractTpl< _Scalar >
ManifoldPtr	space_
	State space.

const int	nu_
	Control space dimension.

Detailed Description

template<typename Scalar>
struct aligator::dynamics::ContinuousCentroidalFwdDynamicsTpl< Scalar >

Nonlinear centroidal forward dynamics with smooth control.

This is described in state-space \(\mathcal{X} = T\mathcal{Q}\) (the phase space \(x = (c,h,L,u)\) with c CoM position, h linear momentum, L angular momentum and u forces) using the differential equation

\[ \dot{x} = f(x, u) = F_x * x + F_u(x) * u \]

as described by the Newton-Euler law of momentum. Control parameter is set to be the derivative of u to ensure force smoothness.

Definition at line 31 of file fwd.hpp.

Member Typedef Documentation

◆ Scalar

template<typename Scalar >

using aligator::dynamics::ContinuousCentroidalFwdDynamicsTpl< Scalar >::Scalar = _Scalar

Definition at line 27 of file continuous-centroidal-fwd.hpp.

◆ Base

template<typename Scalar >

using aligator::dynamics::ContinuousCentroidalFwdDynamicsTpl< Scalar >::Base = ODEAbstractTpl<Scalar>

Definition at line 29 of file continuous-centroidal-fwd.hpp.

◆ BaseData

template<typename Scalar >

using aligator::dynamics::ContinuousCentroidalFwdDynamicsTpl< Scalar >::BaseData = ContinuousDynamicsDataTpl<Scalar>

Definition at line 30 of file continuous-centroidal-fwd.hpp.

◆ ContDataAbstract

template<typename Scalar >

using aligator::dynamics::ContinuousCentroidalFwdDynamicsTpl< Scalar >::ContDataAbstract = ContinuousDynamicsDataTpl<Scalar>

Definition at line 31 of file continuous-centroidal-fwd.hpp.

◆ Data

template<typename Scalar >

using aligator::dynamics::ContinuousCentroidalFwdDynamicsTpl< Scalar >::Data = ContinuousCentroidalFwdDataTpl<Scalar>

Definition at line 32 of file continuous-centroidal-fwd.hpp.

◆ Manifold

template<typename Scalar >

using aligator::dynamics::ContinuousCentroidalFwdDynamicsTpl< Scalar >::Manifold = proxsuite::nlp::VectorSpaceTpl<Scalar>

Definition at line 33 of file continuous-centroidal-fwd.hpp.

◆ Matrix3s

template<typename Scalar >

using aligator::dynamics::ContinuousCentroidalFwdDynamicsTpl< Scalar >::Matrix3s = Eigen::Matrix<Scalar, 3, 3>

Definition at line 34 of file continuous-centroidal-fwd.hpp.

◆ ContactMap

template<typename Scalar >

using aligator::dynamics::ContinuousCentroidalFwdDynamicsTpl< Scalar >::ContactMap = ContactMapTpl<Scalar>

Definition at line 35 of file continuous-centroidal-fwd.hpp.

Constructor & Destructor Documentation

◆ ContinuousCentroidalFwdDynamicsTpl()

template<typename Scalar >

aligator::dynamics::ContinuousCentroidalFwdDynamicsTpl< Scalar >::ContinuousCentroidalFwdDynamicsTpl	(	const Manifold &	state,
		const double	mass,
		const Vector3s &	gravity,
		const ContactMap &	contact_map,
		const int	force_size )

Member Function Documentation

◆ ALIGATOR_DYNAMIC_TYPEDEFS()

template<typename Scalar >

aligator::dynamics::ContinuousCentroidalFwdDynamicsTpl< Scalar >::ALIGATOR_DYNAMIC_TYPEDEFS ( Scalar )

◆ space()

template<typename Scalar >

const Manifold & aligator::dynamics::ContinuousCentroidalFwdDynamicsTpl< Scalar >::space ( ) const

inline

Definition at line 46 of file continuous-centroidal-fwd.hpp.

◆ forward()

template<typename Scalar >

void aligator::dynamics::ContinuousCentroidalFwdDynamicsTpl< Scalar >::forward	(	const ConstVectorRef &	x,
		const ConstVectorRef &	u,
		BaseData &	data ) const

virtual

Evaluate the ODE vector field: this returns the value of \(\dot{x}\).

Implements aligator::dynamics::ODEAbstractTpl< _Scalar >.

◆ dForward()

template<typename Scalar >

void aligator::dynamics::ContinuousCentroidalFwdDynamicsTpl< Scalar >::dForward	(	const ConstVectorRef &	x,
		const ConstVectorRef &	u,
		BaseData &	data ) const