Centroidal Dynamics model relating forces to base accelerations. More...

#include <centroidal_model.h>

Inheritance diagram for towr::CentroidalModel:

Public Member Functions
	CentroidalModel (double mass, const Eigen::Matrix3d &inertia_b, int ee_count)
	Constructs a specific Centroidal model.
	CentroidalModel (double mass, double Ixx, double Iyy, double Izz, double Ixy, double Ixz, double Iyz, int ee_count)
	Constructs a specific Centroidal model.
virtual BaseAcc	GetDynamicViolation () const override
	The violation of the system dynamics incurred by the current values.
virtual Jac	GetJacobianWrtBaseAng (const EulerConverter &base_angular, double t) const override
	How the base orientation affects the dynamic violation.
virtual Jac	GetJacobianWrtBaseLin (const Jac &jac_base_lin_pos, const Jac &jac_acc_base_lin) const override
	How the base position affects the dynamic violation.
virtual Jac	GetJacobianWrtEEPos (const Jac &jac_ee_pos, EE) const override
	How the endeffector positions affect the dynamic violation.
virtual Jac	GetJacobianWrtForce (const Jac &jac_force, EE) const override
	How the endeffector forces affect the dynamic violation.
virtual	~CentroidalModel ()
Private Attributes
Eigen::SparseMatrix< double, Eigen::RowMajor >	I_b

Detailed Description

Centroidal Dynamics model relating forces to base accelerations.

This class implements a simplified Centroidal dynamics model, a reduced dimensional model, lying in terms of accuracy between a simple Linear Inverted Pendulum model and a complex full Centroidal (https://doi.org/10.1007/s10514-013-9341-4) or Rigid-body-dynamics Model.

This model makes the assumption that the motion of the limbs does not incur significant momentum and can therefore be neglected. This eliminates the often very nonnlinear dependency on joint angles and allows to express all quantities in Cartesian space.

See also:: https://en.wikipedia.org/wiki/Newton%E2%80%93Euler_equations

Definition at line 53 of file centroidal_model.h.

Constructor & Destructor Documentation

towr::CentroidalModel::CentroidalModel	(	double	mass,
		const Eigen::Matrix3d &	inertia_b,
		int	ee_count
	)

Constructs a specific Centroidal model.

Parameters:

mass	The mass of the robot.
ee_count	The number of endeffectors/forces.
inertia_b	The elements of the 3x3 Inertia matrix around the CoM. This matrix maps angular accelerations expressed in base frame to Moments in base frame.

Definition at line 69 of file centroidal_model.cc.

towr::CentroidalModel::CentroidalModel	(	double	mass,
		double	Ixx,
		double	Iyy,
		double	Izz,
		double	Ixy,
		double	Ixz,
		double	Iyz,
		int	ee_count
	)

Constructs a specific Centroidal model.

Parameters:

mass	Mass of the robot.
I..	Elements of the 3x3 Inertia matrix (

See also:: CentroidalModel())

Parameters:

ee_count Number of endeffectors/forces.

Definition at line 59 of file centroidal_model.cc.

virtual towr::CentroidalModel::~CentroidalModel ( ) [virtual]

Member Function Documentation

CentroidalModel::BaseAcc towr::CentroidalModel::GetDynamicViolation ( ) const [override, virtual]

The violation of the system dynamics incurred by the current values.

Returns:: The 6-dimension generalized force violation (angular + linear).

Implements towr::DynamicModel.

Definition at line 77 of file centroidal_model.cc.

CentroidalModel::Jac towr::CentroidalModel::GetJacobianWrtBaseAng	(	const EulerConverter &	base_angular,
		double	t
	)		const `[override, virtual]`

How the base orientation affects the dynamic violation.

Parameters:

base_angular	provides Euler angles Jacobians.
t	Time at which euler angles values are queried.

Returns:: The 6xn Jacobian of dynamic violations with respect to variables defining the base angular spline (e.g. node values).

Implements towr::DynamicModel.

Definition at line 124 of file centroidal_model.cc.

CentroidalModel::Jac towr::CentroidalModel::GetJacobianWrtBaseLin	(	const Jac &	jac_base_lin_pos,
		const Jac &	jac_base_lin_acc
	)		const `[override, virtual]`

How the base position affects the dynamic violation.

Parameters:

jac_base_lin_pos	The 3xn Jacobian of the base linear position.
jac_base_lin_acc	The 3xn Jacobian of the base linear acceleration.

Returns:: The 6xn Jacobian of dynamic violations with respect to variables defining the base linear spline (e.g. node values).

Implements towr::DynamicModel.

Definition at line 104 of file centroidal_model.cc.

CentroidalModel::Jac towr::CentroidalModel::GetJacobianWrtEEPos	(	const Jac &	ee_pos,
		EE	ee
	)		const `[override, virtual]`

How the endeffector positions affect the dynamic violation.

Parameters:

ee_force	The 3xn Jacobian of the foot position x,y,z.
ee	The endeffector for which the senstivity is required.

Returns:: The 6xn Jacobian of dynamic violations with respect to variables defining the foot positions (e.g. node values).

Implements towr::DynamicModel.

Definition at line 182 of file centroidal_model.cc.

CentroidalModel::Jac towr::CentroidalModel::GetJacobianWrtForce	(	const Jac &	ee_force,
		EE	ee
	)		const `[override, virtual]`

How the endeffector forces affect the dynamic violation.

Parameters:

ee_force	The 3xn Jacobian of the foot force x,y,z.
ee	The endeffector for which the senstivity is required.

Returns:: The 6xn Jacobian of dynamic violations with respect to variables defining the endeffector forces (e.g. node values).

Implements towr::DynamicModel.

Definition at line 168 of file centroidal_model.cc.

Member Data Documentation

Eigen::SparseMatrix<double, Eigen::RowMajor> towr::CentroidalModel::I_b [private]

Inertia of entire robot around the CoM expressed in a frame anchored in the base.

Definition at line 93 of file centroidal_model.h.

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

Public Member Functions

Private Attributes

Detailed Description

Constructor & Destructor Documentation

Member Function Documentation

Member Data Documentation