Detailed Description

[task_cop.m]

Definition at line 19 of file task_bodyjerkminimization.h.

#include <task_bodyjerkminimization.h>

Inheritance diagram for humoto::pepper_mpc::TaskBodyJerkMinimization:

Public Member Functions
	TaskBodyJerkMinimization (const double gain=0.707106781186548)

void	addATAandATb (Eigen::MatrixXd &H, Eigen::VectorXd &g) const
	Compute 'A^T * A' for general equality constaints and save or add the result to H. Compute 'A^T * b' for general equality constaints and save or add the result to g. More...

void	checkConsistency () const
	Check consistency of the constraints. More...

void	computeViolations (ViolationsConstraints &violations, const Location &location, const Solution &solution) const
	Compute violations given a solution vector. More...

void	copyBodyTo (Eigen::MatrixXd &A, const Location &location) const
	Copy body to the given matrix. More...

void	copyBoundsTo (Eigen::VectorXd &lb, Eigen::VectorXd &ub, const Location &location) const
	Copy bounds to given vectors. More...

void	copyNegativeBodyTo (Eigen::MatrixXd &A, const Location &location) const
	Copy body to the given matrix. More...

virtual std::size_t	copyTo (ContainerILU &container, const std::size_t constraints_offset) const
	Set constraints. More...

virtual std::size_t	copyTo (ContainerAL &container, const std::size_t constraints_offset) const
	Copy constraints to a container. More...

std::size_t	copyTo (ContainerALU &container, const std::size_t constraints_offset) const
	Set constraints. More...

std::size_t	copyTo (ContainerAB &container, const std::size_t constraints_offset) const
	Set constraints. More...

void	determineActiveSet (ActiveSetConstraints &active_set, const Location &location, const Solution &solution) const
	Determine active set given a solution vector. More...

void	form (const humoto::SolutionStructure &sol_structure, const humoto::Model &model_base, const humoto::ControlProblem &control_problem)
	Form task. More...

void	getATAandATb (Eigen::MatrixXd &H, Eigen::VectorXd &g) const
	Compute 'A^T * A' for general equality constaints and save or add the result to H. Compute 'A^T * b' for general equality constaints and save or add the result to g. More...

Location	getCopyLocation (const std::size_t number_of_constraints, const std::size_t constraints_offset, const std::size_t number_of_variables) const
	Computes location of the copied constraints in a container and verifies their consistency. More...

const std::string	getDescription () const
	Get description of the task. More...

double	getGain () const
	Returns gain. More...

Eigen::VectorXd &	getIGains ()
	Get gains for each element in simple objective. More...

const Eigen::VectorXd &	getIGains () const
	Get gains for each element in simple objective. More...

humoto::IndexVector &	getIndices ()
	Get indices. More...

const humoto::IndexVector &	getIndices () const
	Get indices. More...

std::size_t	getNumberOfConstraints () const
	Returns number of constraints in the task. More...

std::size_t	getNumberOfVariables () const
	Returns number of variables in the task. More...

double	getProduct (const std::size_t i, const Eigen::VectorXd &vector) const
	Compute A(i,:) * vector. More...

ConstraintType::Type	getType () const
	Returns type of the constraints. More...

bool	isEquality () const
	Check properties of the constriaints. More...

bool	isSimple () const
	Check properties of the constriaints. More...

bool	isTwoSidedInequality () const
	Check properties of the constriaints. More...

void	log (humoto::Logger &logger, const LogEntryName &parent=LogEntryName(), const std::string &name="task") const
	Log task. More...

void	readConfig (t_Reader &reader, const bool crash_on_missing_entry=default_crash_on_missing_entry_)
	Read configuration (assuming the configuration node to be in the root). More...

void	readConfig (t_Reader &reader, const std::string &node_name, const bool crash_on_missing_entry=default_crash_on_missing_entry_)
	Read configuration (assuming the configuration node to be in the root). More...

void	readConfig (t_Reader &reader, const char *node_name, const bool crash_on_missing_entry=default_crash_on_missing_entry_)
	Read configuration (assuming the configuration node to be in the root). More...

void	readConfig (const std::string &file_name, const bool crash_on_missing_entry=default_crash_on_missing_entry_)
	Read configuration (assuming the configuration node to be in the root). More...

void	readConfig (const std::string &file_name, const std::string &node_name, const bool crash_on_missing_entry=default_crash_on_missing_entry_)
	Read configuration (assuming the configuration node to be in the root). More...

void	readConfig (const std::string &file_name, const char *node_name, const bool crash_on_missing_entry=default_crash_on_missing_entry_)
	Read configuration (assuming the configuration node to be in the root). More...

void	readNestedConfig (t_Reader &reader, const std::string &node_name, const bool crash_on_missing_entry=default_crash_on_missing_entry_)
	Read nested configuration node. More...

void	setDescription (const std::string &description)
	Set description of the task. More...

virtual void	setGain (const double gain)
	Sets gain. More...

void	setVariablesID (const std::string &variables_id)
	Set variables string id to a given value. More...

void	writeConfig (t_Writer &writer) const
	Write configuration. More...

void	writeConfig (t_Writer &writer, const std::string &node_name) const
	Write configuration. More...

void	writeConfig (const std::string &file_name) const
	Write configuration. More...

void	writeConfig (const std::string &file_name, const std::string &node_name) const
	Write configuration. More...

void	writeNestedConfig (t_Writer &writer) const
	Write nested configuration node. More...

void	writeNestedConfig (t_Writer &writer, const std::string &node_name) const
	Write nested configuration node. More...

Protected Member Functions
void	addATA (Eigen::MatrixXd &H) const
	Compute 'A^T * A' for general equality constaints and save or add the result to H. More...

void	addATb (Eigen::VectorXd &g) const
	Compute 'A^T * b' for general equality constaints and save or add the result to g. More...

void	copyEqualityBoundsTo (Eigen::VectorXd &b, const Location &location) const
	Copy b. More...

void	finalize ()

ActiveSetConstraints &	getActiveSetGuess ()
	Get active set guess. More...

const ActiveSetConstraints &	getActualActiveSet () const
	Get actual active set. More...

void	getATA (Eigen::MatrixXd &H) const
	Compute 'A^T * A' for general equality constaints and save or add the result to H. More...

void	getATb (Eigen::VectorXd &g) const
	Compute 'A^T * b' for general equality constaints and save or add the result to g. More...

const std::string &	getConfigSectionID () const
	Return the default name of a configuration node corresponding to this class. More...

virtual std::size_t	getNumberOfEntries () const=0
	Get number of entries in the corresponding configuration node. More...

virtual void	guessActiveSet (const humoto::SolutionStructure &sol_structure, const humoto::Model &model_base, const humoto::ControlProblem &control_problem)
	Initialize active set guess with defaults. More...

void	logBody (humoto::Logger &logger, const LogEntryName &parent=LogEntryName(), const std::string &name="constraints") const
	Log body. More...

void	logBounds (humoto::Logger &logger, const LogEntryName &parent=LogEntryName(), const std::string &name="constraints") const
	Log bounds. More...

virtual void	logTask (humoto::Logger &logger, const LogEntryName &parent=LogEntryName(), const std::string &name="task") const
	Log task. More...

void	markAsUnmodified ()
	By default the task is assumed to be modified. Use this function to mark it as unmodified to avoid unnecessary recomputations. More...

void	reset (const std::size_t number_of_constraints=0, const std::size_t number_of_variables=0, const bool initialize_matrices=false)
	Initialize constraints. More...

void	resetBody (const std::size_t number_of_constraints=0, const bool initialize_matrices=false)
	Initialize I and gains. More...

void	resetBounds (const std::size_t number_of_constraints=0, const bool initialize_matrices=false)
	Reset bounds of constraints (b, lb, ub) More...

virtual void	setDefaults ()

void	setNumberOfVariables (const std::size_t number_of_variables)
	Set number of variables. More...

Protected Attributes
ActiveSetConstraints	active_set_actual_

double	gain_

humoto::IndexVector	I_

Eigen::VectorXd	I_gains_

bool	is_modified_

std::size_t	number_of_variables_

Static Protected Attributes
static const bool	default_crash_on_missing_entry_

Constructor & Destructor Documentation

◆ TaskBodyJerkMinimization()

humoto::pepper_mpc::TaskBodyJerkMinimization::TaskBodyJerkMinimization ( const double gain = 0.707106781186548 )

inlineexplicit

Definition at line 22 of file task_bodyjerkminimization.h.

Member Function Documentation

◆ addATA()

void humoto::constraints::BodyGIMixin< BoundsB0Mixin< TaskBase > >::addATA ( Eigen::MatrixXd & H ) const

inlineprotectedinherited

Compute 'A^T * A' for general equality constaints and save or add the result to H.

Parameters

[in,out] H left lower triangular part of the result.

Attention: Only the left lower triangular part of H is formed. Apply appropriate conversion with etools::convertLLTtoSymmetric() before using H.

Definition at line 945 of file constraints_mixins.h.

◆ addATAandATb()

void humoto::constraints::ConstraintsGIB0< TaskBase >::addATAandATb	(	Eigen::MatrixXd &	H,
		Eigen::VectorXd &	g
	)		const

inlinevirtualinherited

Compute 'A^T * A' for general equality constaints and save or add the result to H. Compute 'A^T * b' for general equality constaints and save or add the result to g.

Parameters

[in,out]	H	left lower triangular part of the result.
[in,out]	g	result

Attention: Only the left lower triangular part of H is formed. Apply appropriate conversion with etools::convertLLTtoSymmetric() before using H.

Reimplemented from humoto::constraints::ConstraintsBase.

Definition at line 814 of file constraints.h.

◆ addATb()

void humoto::constraints::BoundsB0Mixin< TaskBase >::addATb ( Eigen::VectorXd & g ) const

inlineprotectedinherited

Compute 'A^T * b' for general equality constaints and save or add the result to g.

Parameters

[in,out] g result

Definition at line 77 of file constraints_mixins.h.

◆ checkConsistency()

void humoto::constraints::ConstraintsGIB0< TaskBase >::checkConsistency ( ) const

inlinevirtualinherited

Check consistency of the constraints.

Implements humoto::constraints::ConstraintsBase.

Definition at line 822 of file constraints.h.

◆ computeViolations()

void humoto::constraints::ViolationsComputationB0Mixin< ActiveSetDeterminationBMixin< BodyGIMixin< BoundsB0Mixin< TaskBase > > > >::computeViolations	(	ViolationsConstraints &	violations,
		const Location &	location,
		const Solution &	solution
	)		const

inlinevirtualinherited

Compute violations given a solution vector.

Parameters

[in,out]	violations	violations
[in]	location	location of the constraints in the active set
[in]	solution	solution vector

Implements humoto::constraints::ConstraintsBase.

Definition at line 1366 of file constraints_mixins.h.

◆ copyBodyTo()

void humoto::constraints::BodyGIMixin< BoundsB0Mixin< TaskBase > >::copyBodyTo	(	Eigen::MatrixXd &	A,
		const Location &	location
	)		const

inlinevirtualinherited

Copy body to the given matrix.

Parameters

[in]	A
[in]	location	offset and length

Reimplemented from humoto::constraints::BodyIMixin< BoundsB0Mixin< TaskBase > >.

Definition at line 976 of file constraints_mixins.h.

◆ copyBoundsTo()

void humoto::constraints::BoundsB0Mixin< TaskBase >::copyBoundsTo	(	Eigen::VectorXd &	lb,
		Eigen::VectorXd &	ub,
		const Location &	location
	)		const

inlinevirtualinherited

Copy bounds to given vectors.

Parameters

[in]	lb
[in]	ub
[in]	location	offset and length

Implements humoto::constraints::ConstraintsBase.

Definition at line 98 of file constraints_mixins.h.

◆ copyEqualityBoundsTo()

void humoto::constraints::BoundsB0Mixin< TaskBase >::copyEqualityBoundsTo	(	Eigen::VectorXd &	b,
		const Location &	location
	)		const

inlineprotectedinherited

Copy b.

Parameters

[in,out]	b
[in]	location

Definition at line 89 of file constraints_mixins.h.

◆ copyNegativeBodyTo()

void humoto::constraints::BodyGIMixin< BoundsB0Mixin< TaskBase > >::copyNegativeBodyTo	(	Eigen::MatrixXd &	A,
		const Location &	location
	)		const

inlinevirtualinherited

Copy body to the given matrix.

Parameters

[in]	A
[in]	location	offset and length

Reimplemented from humoto::constraints::BodyIMixin< BoundsB0Mixin< TaskBase > >.

Definition at line 993 of file constraints_mixins.h.

◆ copyTo() [1/4]

virtual std::size_t humoto::constraints::ConstraintsBase::copyTo	(	ContainerILU &	container,
		const std::size_t	constraints_offset
	)		const

inlinevirtualinherited

Set constraints.

Parameters

[in,out]	container	new constraints
[in]	constraints_offset	first row offset

Returns: offset of the end of added constraints

Reimplemented in humoto::constraints::CopySimpleToILUMixin< CopyEqualityToABMixin< ViolationsComputationBMixin< ActiveSetDeterminationBMixin< BodyIMixin< BoundsBMixin< TaskBase > > > > > >, humoto::constraints::CopySimpleToILUMixin< ViolationsComputationLUMixin< ActiveSetDeterminationLUMixin< BodyIMixin< BoundsLUMixin< TaskBase > > > > >, humoto::constraints::CopySimpleToILUMixin< ViolationsComputationLMixin< ActiveSetDeterminationLMixin< BodyIMixin< BoundsLMixin< TaskBase > > > > >, humoto::constraints::CopySimpleToILUMixin< ViolationsComputationUMixin< ActiveSetDeterminationUMixin< BodyIMixin< BoundsUMixin< TaskBase > > > > >, and humoto::constraints::CopySimpleToILUMixin< CopyEqualityToABMixin< ViolationsComputationB0Mixin< ActiveSetDeterminationBMixin< BodyIMixin< BoundsB0Mixin< TaskBase > > > > > >.

Definition at line 457 of file constraints_base.h.

◆ copyTo() [2/4]

virtual std::size_t humoto::constraints::ConstraintsBase::copyTo	(	ContainerAL &	container,
		const std::size_t	constraints_offset
	)		const

inlinevirtualinherited

Copy constraints to a container.

Parameters

[in,out]	container
[in]	constraints_offset	first row offset

Returns: offset of the end of added constraints

Definition at line 472 of file constraints_base.h.

◆ copyTo() [3/4]

std::size_t humoto::constraints::CopyAnyToALUMixin< CopyEqualityToABMixin< ViolationsComputationB0Mixin< ActiveSetDeterminationBMixin< BodyGIMixin< BoundsB0Mixin< TaskBase > > > > > >::copyTo	(	ContainerALU &	container,
		const std::size_t	constraints_offset
	)		const

inlinevirtualinherited

Set constraints.

Parameters

[in,out]	container	new constraints
[in]	constraints_offset	first row offset

Returns: offset of the end of added constraints

Reimplemented from humoto::constraints::ConstraintsBase.

Definition at line 615 of file constraints_base.h.

◆ copyTo() [4/4]

std::size_t humoto::constraints::CopyEqualityToABMixin< ViolationsComputationB0Mixin< ActiveSetDeterminationBMixin< BodyGIMixin< BoundsB0Mixin< TaskBase > > > > >::copyTo	(	ContainerAB &	container,
		const std::size_t	constraints_offset
	)		const

inlinevirtualinherited

Set constraints.

Parameters

[in,out]	container	new constraints
[in]	constraints_offset	first row offset

Returns: offset of the end of added constraints

Reimplemented from humoto::constraints::ConstraintsBase.

Definition at line 777 of file constraints_base.h.

◆ determineActiveSet()

void humoto::constraints::ActiveSetDeterminationBMixin< BodyGIMixin< BoundsB0Mixin< TaskBase > > >::determineActiveSet	(	ActiveSetConstraints &	active_set,
		const Location &	location,
		const Solution &	solution
	)		const

inlinevirtualinherited

Determine active set given a solution vector.

Parameters

[in,out]	active_set	active set
[in]	location	location of the constraints in the active set
[in]	solution	solution vector

Implements humoto::constraints::ConstraintsBase.

Definition at line 1187 of file constraints_mixins.h.

◆ finalize()

void humoto::WeightedSimpleTaskBaseMixin< constraints::ConstraintsGIB0< TaskBase > >::finalize ( )

inlineprotectedvirtualinherited

Reimplemented from humoto::config::CommonConfigurableBase< true >.

Definition at line 428 of file task.h.

◆ form()

void humoto::TaskZeroVariables::form	(	const humoto::SolutionStructure &	sol_structure,
		const humoto::Model &	model_base,
		const humoto::ControlProblem &	control_problem
	)

inlinevirtualinherited

Form task.

Parameters

[in]	sol_structure	structure of the solution
[in]	model_base	model
[in]	control_problem	control problem

Implements humoto::TaskBase.

Definition at line 78 of file task_generic.h.

◆ getActiveSetGuess()

ActiveSetConstraints& humoto::TaskBase::getActiveSetGuess ( )

inlineprotectedinherited

Get active set guess.

Returns: active set guess.

Definition at line 226 of file task.h.

◆ getActualActiveSet()

const ActiveSetConstraints& humoto::TaskBase::getActualActiveSet ( ) const

inlineprotectedinherited

Get actual active set.

Returns: actual active set.

Definition at line 215 of file task.h.

◆ getATA()

void humoto::constraints::BodyGIMixin< BoundsB0Mixin< TaskBase > >::getATA ( Eigen::MatrixXd & H ) const

inlineprotectedinherited

Compute 'A^T * A' for general equality constaints and save or add the result to H.

Parameters

[in,out] H left lower triangular part of the result.

Attention: Only the left lower triangular part of H is formed. Apply appropriate conversion with etools::convertLLTtoSymmetric() before using H.

Definition at line 935 of file constraints_mixins.h.

◆ getATAandATb()

void humoto::constraints::ConstraintsGIB0< TaskBase >::getATAandATb	(	Eigen::MatrixXd &	H,
		Eigen::VectorXd &	g
	)		const

inlinevirtualinherited

Compute 'A^T * A' for general equality constaints and save or add the result to H. Compute 'A^T * b' for general equality constaints and save or add the result to g.

Parameters

[in,out]	H	left lower triangular part of the result.
[in,out]	g	result

Attention: Only the left lower triangular part of H is formed. Apply appropriate conversion with etools::convertLLTtoSymmetric() before using H.

Reimplemented from humoto::constraints::ConstraintsBase.

Definition at line 806 of file constraints.h.

◆ getATb()

void humoto::constraints::BoundsB0Mixin< TaskBase >::getATb ( Eigen::VectorXd & g ) const

inlineprotectedinherited

Compute 'A^T * b' for general equality constaints and save or add the result to g.

Parameters

[in,out] g result

Definition at line 70 of file constraints_mixins.h.

◆ getConfigSectionID()

const std::string& humoto::TaskBase::getConfigSectionID ( ) const

inlineprotectedvirtualinherited

Return the default name of a configuration node corresponding to this class.

Returns: the name

Attention: Implementation of this method is added automatically upon inclusion of define_accessors.h if HUMOTO_CONFIG_SECTION_ID is defined.

Implements humoto::config::CommonConfigurableBase< true >.

Definition at line 122 of file task.h.

◆ getCopyLocation()

Location humoto::constraints::ContainerBase::getCopyLocation	(	const std::size_t	number_of_constraints,
		const std::size_t	constraints_offset,
		const std::size_t	number_of_variables
	)		const

inlineinherited

Computes location of the copied constraints in a container and verifies their consistency.

Parameters

[in]	number_of_constraints	number of added constraints
[in]	constraints_offset	offset in the container
[in]	number_of_variables	number of variables in the container

Returns: Location

Definition at line 262 of file constraints_base.h.

◆ getDescription()

const std::string humoto::TaskBase::getDescription ( ) const

inlineinherited

Get description of the task.

Returns: description

Definition at line 249 of file task.h.

◆ getGain()

double humoto::WeightedSimpleTaskBaseMixin< constraints::ConstraintsGIB0< TaskBase > >::getGain ( ) const

inlineinherited

Returns gain.

Returns: gain

Definition at line 464 of file task.h.

◆ getIGains() [1/2]

Eigen::VectorXd& humoto::constraints::BodyGIMixin< BoundsB0Mixin< TaskBase > >::getIGains ( )

inlineinherited

Get gains for each element in simple objective.

Returns: gains

Definition at line 963 of file constraints_mixins.h.

◆ getIGains() [2/2]

const Eigen::VectorXd& humoto::constraints::BodyGIMixin< BoundsB0Mixin< TaskBase > >::getIGains ( ) const

inlineinherited

Get gains for each element in simple objective.

Returns: gains

Definition at line 969 of file constraints_mixins.h.

◆ getIndices() [1/2]

humoto::IndexVector& humoto::constraints::BodyIMixin< BoundsB0Mixin< TaskBase > >::getIndices ( )

inlineinherited

Get indices.

Returns: indices

Definition at line 852 of file constraints_mixins.h.

◆ getIndices() [2/2]

const humoto::IndexVector& humoto::constraints::BodyIMixin< BoundsB0Mixin< TaskBase > >::getIndices ( ) const

inlineinherited

Get indices.

Returns: indices

Definition at line 859 of file constraints_mixins.h.

◆ getNumberOfConstraints()

std::size_t humoto::constraints::BodyIMixin< BoundsB0Mixin< TaskBase > >::getNumberOfConstraints ( ) const

inlinevirtualinherited

Returns number of constraints in the task.

Returns: number of constraints

Implements humoto::constraints::ContainerBase.

Definition at line 866 of file constraints_mixins.h.

◆ getNumberOfEntries()

virtual std::size_t humoto::config::CommonConfigurableBase< t_crash_on_missing_entry >::getNumberOfEntries ( ) const

protectedpure virtualinherited

Get number of entries in the corresponding configuration node.

Returns: number of entries

Implemented in humoto::ConfigurableOptimizationProblem.

◆ getNumberOfVariables()

std::size_t humoto::constraints::ContainerBase::getNumberOfVariables ( ) const

inlineinherited

Returns number of variables in the task.

Returns: number of variables

Definition at line 215 of file constraints_base.h.

◆ getProduct()

double humoto::constraints::BodyGIMixin< BoundsB0Mixin< TaskBase > >::getProduct	(	const std::size_t	i,
		const Eigen::VectorXd &	vector
	)		const

inlineinherited

Compute A(i,:) * vector.

Parameters

[in]	i	row index
[in]	vector	vector

Returns: result of multiplication

Definition at line 1010 of file constraints_mixins.h.

◆ getType()

ConstraintType::Type humoto::constraints::ConstraintsGIB0< TaskBase >::getType ( ) const

inlinevirtualinherited

Returns type of the constraints.

Returns: type of the constraints

Implements humoto::constraints::ConstraintsBase.

Definition at line 799 of file constraints.h.

◆ guessActiveSet()

virtual void humoto::TaskBase::guessActiveSet	(	const humoto::SolutionStructure &	sol_structure,
		const humoto::Model &	model_base,
		const humoto::ControlProblem &	control_problem
	)

inlineprotectedvirtualinherited

Initialize active set guess with defaults.

Parameters

[in]	sol_structure	structure of the solution
[in]	model_base	model
[in]	control_problem	control problem

Attention: This function is called automatically (after form()) and can be redefined in derfived tasks. It doesn't make sense to redefine it for equality tasks.

Reimplemented in humoto::wpg04::TaskFootstepBounds, humoto::wpg04::TaskCoPBounds, humoto::pepper_mpc::TaskBaseAccelerationBounds, humoto::pepper_mpc::TaskBaseVelocityBounds, humoto::pepper_mpc::TaskCoPPositionBounds, and humoto::pepper_mpc::TaskBodyPositionBounds.

Definition at line 147 of file task.h.

◆ isEquality()

bool humoto::constraints::ConstraintsBase::isEquality ( ) const

inlineinherited

Check properties of the constriaints.

Returns: true/false

Definition at line 523 of file constraints_base.h.

◆ isSimple()

bool humoto::constraints::ConstraintsBase::isSimple ( ) const

inlineinherited

Check properties of the constriaints.

Returns: true/false

Definition at line 529 of file constraints_base.h.

◆ isTwoSidedInequality()

bool humoto::constraints::ConstraintsBase::isTwoSidedInequality ( ) const

inlineinherited

Check properties of the constriaints.

Returns: true/false

Definition at line 535 of file constraints_base.h.

◆ log()

void humoto::TaskBase::log	(	humoto::Logger &	logger,
		const LogEntryName &	parent = `LogEntryName()`,
		const std::string &	name = `"task"`
	)		const

inlineinherited

Log task.

Parameters

[in,out]	logger	logger
[in]	parent	parent
[in]	name	name

Definition at line 273 of file task.h.

◆ logBody()

void humoto::constraints::BodyGIMixin< BoundsB0Mixin< TaskBase > >::logBody	(	humoto::Logger &	logger,
		const LogEntryName &	parent = `LogEntryName()`,
		const std::string &	name = `"constraints"`
	)		const

inlineprotectedvirtualinherited

Log body.

Parameters

[in,out]	logger	logger
[in]	parent	parent
[in]	name	name

Reimplemented from humoto::constraints::BodyIMixin< BoundsB0Mixin< TaskBase > >.

Definition at line 922 of file constraints_mixins.h.

◆ logBounds()

void humoto::constraints::BoundsB0Mixin< TaskBase >::logBounds	(	humoto::Logger &	logger,
		const LogEntryName &	parent = `LogEntryName()`,
		const std::string &	name = `"constraints"`
	)		const

inlineprotectedvirtualinherited

Log bounds.

Parameters

[in,out]	logger	logger
[in]	parent	parent
[in]	name	name

Implements humoto::constraints::ContainerBase.

Definition at line 56 of file constraints_mixins.h.

◆ logTask()

virtual void humoto::WeightedSimpleTaskBaseMixin< constraints::ConstraintsGIB0< TaskBase > >::logTask	(	humoto::Logger &	logger,
		const LogEntryName &	parent = `LogEntryName()`,
		const std::string &	name = `"task"`
	)		const

inlineprotectedvirtualinherited

Log task.

Parameters

[in,out]	logger	logger
[in]	parent	parent
[in]	name	name

Implements humoto::TaskBase.

Definition at line 438 of file task.h.

◆ markAsUnmodified()

void humoto::TaskBase::markAsUnmodified ( )

inlineprotectedinherited

By default the task is assumed to be modified. Use this function to mark it as unmodified to avoid unnecessary recomputations.

Attention: This method should be called from form() method only.; If this function is called on a modified task, the result is undefined.

Definition at line 204 of file task.h.

◆ readConfig() [1/6]

void humoto::config::CommonConfigurableBase< t_crash_on_missing_entry >::readConfig	(	t_Reader &	reader,
		const bool	crash_on_missing_entry = `default_crash_on_missing_entry_`
	)

inlineinherited

Read configuration (assuming the configuration node to be in the root).

Parameters

[in]	reader	configuration reader
[in]	crash_on_missing_entry

Definition at line 167 of file config.h.

◆ readConfig() [2/6]

void humoto::config::CommonConfigurableBase< t_crash_on_missing_entry >::readConfig	(	t_Reader &	reader,
		const std::string &	node_name,
		const bool	crash_on_missing_entry = `default_crash_on_missing_entry_`
	)

inlineinherited

Read configuration (assuming the configuration node to be in the root).

Parameters

[in]	reader	configuration reader
[in]	crash_on_missing_entry
[in]	node_name	node name, the default is used if empty

Definition at line 183 of file config.h.

◆ readConfig() [3/6]

void humoto::config::CommonConfigurableBase< t_crash_on_missing_entry >::readConfig	(	t_Reader &	reader,
		const char *	node_name,
		const bool	crash_on_missing_entry = `default_crash_on_missing_entry_`
	)

inlineinherited

Read configuration (assuming the configuration node to be in the root).

Parameters

[in]	reader	configuration reader
[in]	crash_on_missing_entry
[in]	node_name	node name, the default is used if empty

Note: Intercept implicit conversion of a pointer to bool.

Definition at line 202 of file config.h.

◆ readConfig() [4/6]

void humoto::config::CommonConfigurableBase< t_crash_on_missing_entry >::readConfig	(	const std::string &	file_name,
		const bool	crash_on_missing_entry = `default_crash_on_missing_entry_`
	)

inlineinherited

Read configuration (assuming the configuration node to be in the root).

Parameters

[in]	file_name	file name
[in]	crash_on_missing_entry

Definition at line 218 of file config.h.

◆ readConfig() [5/6]

void humoto::config::CommonConfigurableBase< t_crash_on_missing_entry >::readConfig	(	const std::string &	file_name,
		const std::string &	node_name,
		const bool	crash_on_missing_entry = `default_crash_on_missing_entry_`
	)

inlineinherited

Read configuration (assuming the configuration node to be in the root).

Parameters

[in]	file_name	file name
[in]	node_name	node name, the default is used if empty
[in]	crash_on_missing_entry

Definition at line 235 of file config.h.

◆ readConfig() [6/6]

void humoto::config::CommonConfigurableBase< t_crash_on_missing_entry >::readConfig	(	const std::string &	file_name,
		const char *	node_name,
		const bool	crash_on_missing_entry = `default_crash_on_missing_entry_`
	)

inlineinherited

Read configuration (assuming the configuration node to be in the root).

Parameters

[in]	file_name	file name
[in]	crash_on_missing_entry
[in]	node_name	node name, the default is used if empty

Note: Intercept implicit conversion of a pointer to bool.

Definition at line 255 of file config.h.

◆ readNestedConfig()

void humoto::config::CommonConfigurableBase< t_crash_on_missing_entry >::readNestedConfig	(	t_Reader &	reader,
		const std::string &	node_name,
		const bool	crash_on_missing_entry = `default_crash_on_missing_entry_`
	)

inlineinherited

Read nested configuration node.

Parameters

[in]	reader
[in]	crash_on_missing_entry
[in]	node_name	node name, the default is used if empty

Definition at line 132 of file config.h.

◆ reset()

void humoto::constraints::ContainerBase::reset	(	const std::size_t	number_of_constraints = `0`,
		const std::size_t	number_of_variables = `0`,
		const bool	initialize_matrices = `false`
	)

inlineprotectedinherited

Initialize constraints.

Parameters

[in]	number_of_constraints	number of constraints
[in]	number_of_variables	number of variables
[in]	initialize_matrices	initialize matrices using defaults

Definition at line 175 of file constraints_base.h.

◆ resetBody()

void humoto::constraints::BodyGIMixin< BoundsB0Mixin< TaskBase > >::resetBody	(	const std::size_t	number_of_constraints = `0`,
		const bool	initialize_matrices = `false`
	)

inlineprotectedvirtualinherited

Initialize I and gains.

Parameters

[in]	number_of_constraints	number of constraints
[in]	initialize_matrices	initialize matrices using defaults

Reimplemented from humoto::constraints::BodyIMixin< BoundsB0Mixin< TaskBase > >.

Definition at line 912 of file constraints_mixins.h.

◆ resetBounds()

void humoto::constraints::BoundsB0Mixin< TaskBase >::resetBounds	(	const std::size_t	number_of_constraints = `0`,
		const bool	initialize_matrices = `false`
	)

inlineprotectedvirtualinherited

Reset bounds of constraints (b, lb, ub)

Parameters

[in]	number_of_constraints	number of constraints
[in]	initialize_matrices	initialize matrices using defaults

Implements humoto::constraints::ContainerBase.

Definition at line 48 of file constraints_mixins.h.

◆ setDefaults()

virtual void humoto::WeightedSimpleTaskBaseMixin< constraints::ConstraintsGIB0< TaskBase > >::setDefaults ( )

inlineprotectedvirtualinherited

Reimplemented from humoto::TaskBase.

Reimplemented in humoto::wpg04::TaskCoPPosition.

Definition at line 424 of file task.h.

◆ setDescription()

void humoto::TaskBase::setDescription ( const std::string & description )

inlineinherited

Set description of the task.

Returns: description

Definition at line 260 of file task.h.

◆ setGain()

virtual void humoto::WeightedSimpleTaskBaseMixin< constraints::ConstraintsGIB0< TaskBase > >::setGain ( const double gain )

inlinevirtualinherited

Sets gain.

Parameters

[in] gain new gain

Definition at line 452 of file task.h.

◆ setNumberOfVariables()

void humoto::constraints::ContainerBase::setNumberOfVariables ( const std::size_t number_of_variables )

inlineprotectedinherited

Set number of variables.

Parameters

[in] number_of_variables number of variables

Definition at line 142 of file constraints_base.h.

◆ setVariablesID()

void humoto::TaskZeroVariables::setVariablesID ( const std::string & variables_id )

inlineinherited

Set variables string id to a given value.

Parameters

[in] variables_id string id of variables

Definition at line 46 of file task_generic.h.

◆ writeConfig() [1/4]

void humoto::config::CommonConfigurableBase< t_crash_on_missing_entry >::writeConfig ( t_Writer & writer ) const

inlineinherited

Write configuration.

Parameters

[in,out] writer configuration writer

Definition at line 300 of file config.h.

◆ writeConfig() [2/4]

void humoto::config::CommonConfigurableBase< t_crash_on_missing_entry >::writeConfig	(	t_Writer &	writer,
		const std::string &	node_name
	)		const

inlineinherited

Write configuration.

Parameters

[in,out]	writer	configuration writer
[in]	node_name	node name, the default is used if empty

Definition at line 313 of file config.h.

◆ writeConfig() [3/4]

void humoto::config::CommonConfigurableBase< t_crash_on_missing_entry >::writeConfig ( const std::string & file_name ) const

inlineinherited

Write configuration.

Parameters

[in] file_name file name

Definition at line 328 of file config.h.

◆ writeConfig() [4/4]

void humoto::config::CommonConfigurableBase< t_crash_on_missing_entry >::writeConfig	(	const std::string &	file_name,
		const std::string &	node_name
	)		const

inlineinherited

Write configuration.

Parameters

[in]	file_name	file name
[in]	node_name	node name, the default is used if empty

Definition at line 342 of file config.h.

◆ writeNestedConfig() [1/2]

void humoto::config::CommonConfigurableBase< t_crash_on_missing_entry >::writeNestedConfig ( t_Writer & writer ) const

inlineinherited

Write nested configuration node.

Parameters

[in,out] writer configuration writer

Definition at line 272 of file config.h.

◆ writeNestedConfig() [2/2]

void humoto::config::CommonConfigurableBase< t_crash_on_missing_entry >::writeNestedConfig	(	t_Writer &	writer,
		const std::string &	node_name
	)		const

inlineinherited

Write nested configuration node.

Parameters

[in,out]	writer	configuration writer
[in]	node_name	node name, the default is used if empty

Definition at line 285 of file config.h.

Member Data Documentation

◆ active_set_actual_

ActiveSetConstraints humoto::TaskBase::active_set_actual_

protectedinherited

Definition at line 105 of file task.h.

◆ default_crash_on_missing_entry_

const bool humoto::config::CommonConfigurableBase< t_crash_on_missing_entry >::default_crash_on_missing_entry_

staticprotectedinherited

Definition at line 67 of file config.h.

◆ gain_

double humoto::WeightedSimpleTaskBaseMixin< constraints::ConstraintsGIB0< TaskBase > >::gain_

protectedinherited

Definition at line 393 of file task.h.

◆ I_

humoto::IndexVector humoto::constraints::BodyIMixin< BoundsB0Mixin< TaskBase > >::I_

protectedinherited

Definition at line 746 of file constraints_mixins.h.

◆ I_gains_

Eigen::VectorXd humoto::constraints::BodyGIMixin< BoundsB0Mixin< TaskBase > >::I_gains_

protectedinherited

Definition at line 894 of file constraints_mixins.h.

◆ is_modified_

bool humoto::TaskBase::is_modified_

protectedinherited

Definition at line 104 of file task.h.

◆ number_of_variables_

std::size_t humoto::constraints::ContainerBase::number_of_variables_

protectedinherited

Definition at line 120 of file constraints_base.h.

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

modules/pepper_mpc/include/pepper_mpc/task_bodyjerkminimization.h

Detailed Description

Public Member Functions

Protected Member Functions

Protected Attributes

Static Protected Attributes

Constructor & Destructor Documentation

◆ TaskBodyJerkMinimization()

Member Function Documentation

◆ addATA()

◆ addATAandATb()

◆ addATb()

◆ checkConsistency()

◆ computeViolations()

◆ copyBodyTo()

◆ copyBoundsTo()

◆ copyEqualityBoundsTo()

◆ copyNegativeBodyTo()

◆ copyTo() [1/4]

◆ copyTo() [2/4]

◆ copyTo() [3/4]

◆ copyTo() [4/4]

◆ determineActiveSet()

◆ finalize()

◆ form()

◆ getActiveSetGuess()

◆ getActualActiveSet()

◆ getATA()

◆ getATAandATb()

◆ getATb()

◆ getConfigSectionID()

◆ getCopyLocation()

◆ getDescription()

◆ getGain()

◆ getIGains() [1/2]

◆ getIGains() [2/2]

◆ getIndices() [1/2]

◆ getIndices() [2/2]

◆ getNumberOfConstraints()

◆ getNumberOfEntries()

◆ getNumberOfVariables()

◆ getProduct()

◆ getType()

◆ guessActiveSet()

◆ isEquality()

◆ isSimple()

◆ isTwoSidedInequality()

◆ log()

◆ logBody()

◆ logBounds()

◆ logTask()

◆ markAsUnmodified()

◆ readConfig() [1/6]

◆ readConfig() [2/6]

◆ readConfig() [3/6]

◆ readConfig() [4/6]

◆ readConfig() [5/6]

◆ readConfig() [6/6]

◆ readNestedConfig()

◆ reset()

◆ resetBody()

◆ resetBounds()

◆ setDefaults()

◆ setDescription()

◆ setGain()

◆ setNumberOfVariables()

◆ setVariablesID()

◆ writeConfig() [1/4]

◆ writeConfig() [2/4]

◆ writeConfig() [3/4]

◆ writeConfig() [4/4]

◆ writeNestedConfig() [1/2]

◆ writeNestedConfig() [2/2]

Member Data Documentation

◆ active_set_actual_

◆ default_crash_on_missing_entry_

◆ gain_

◆ I_

◆ I_gains_

◆ is_modified_

◆ number_of_variables_