humoto
|
#include <task.h>
Public Member Functions | |
virtual 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 (ContainerAB &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... | |
virtual std::size_t | copyTo (ContainerAL &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... | |
virtual 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... | |
Eigen::VectorXd & | getLowerBounds () |
Get lower bounds (lb/ub vectors from 'lb <= A*x <= ub'). More... | |
const Eigen::VectorXd & | getLowerBounds () const |
Get lower bounds (lb/ub vectors from 'lb <= A*x <= ub'). 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 | 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 | finalize () |
virtual void | form (const humoto::SolutionStructure &sol_structure, const humoto::Model &model_base, const humoto::ControlProblem &control_problem)=0 |
Form the task. More... | |
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... | |
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, 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_ |
Eigen::VectorXd | lb_ |
std::size_t | number_of_variables_ |
Static Protected Attributes | |
static const bool | default_crash_on_missing_entry_ |
|
inlineprotectedinherited |
Compute 'A^T * A' for general equality constaints and save or add the result to H.
[in,out] | H | left lower triangular part of the result. |
Definition at line 945 of file constraints_mixins.h.
|
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.
[in,out] | H | left lower triangular part of the result. |
[in,out] | g | result |
Reimplemented in humoto::constraints::ConstraintsIB0< TaskBase >, humoto::constraints::ConstraintsIB< TaskBase >, humoto::constraints::ConstraintsGIB0< TaskBase >, humoto::constraints::ConstraintsGIB< TaskBase >, humoto::constraints::ConstraintsASB0< TaskBase >, humoto::constraints::ConstraintsASB< TaskBase >, humoto::constraints::ConstraintsAB0< TaskBase >, and humoto::constraints::ConstraintsAB< TaskBase >.
Definition at line 443 of file constraints_base.h.
|
inlinevirtualinherited |
Check consistency of the constraints.
Implements humoto::constraints::ConstraintsBase.
Definition at line 643 of file constraints.h.
|
inlinevirtualinherited |
Compute violations given a solution vector.
[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 1267 of file constraints_mixins.h.
|
inlinevirtualinherited |
Copy body to the given matrix.
[in] | A | |
[in] | location | offset and length |
Reimplemented from humoto::constraints::BodyIMixin< BoundsLMixin< TaskBase > >.
Definition at line 976 of file constraints_mixins.h.
|
inlinevirtualinherited |
Copy bounds to given vectors.
[in] | lb | |
[in] | ub | |
[in] | location | offset and length |
Implements humoto::constraints::ConstraintsBase.
Definition at line 267 of file constraints_mixins.h.
|
inlinevirtualinherited |
Copy body to the given matrix.
[in] | A | |
[in] | location | offset and length |
Reimplemented from humoto::constraints::BodyIMixin< BoundsLMixin< TaskBase > >.
Definition at line 993 of file constraints_mixins.h.
|
inlinevirtualinherited |
Set constraints.
[in,out] | container | new constraints |
[in] | constraints_offset | first row offset |
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.
|
inlinevirtualinherited |
Copy constraints to a container.
[in,out] | container | |
[in] | constraints_offset | first row offset |
Reimplemented in humoto::constraints::CopyEqualityToABMixin< ViolationsComputationBMixin< ActiveSetDeterminationBMixin< BodyAMixin< BoundsBMixin< TaskBase > > > > >, humoto::constraints::CopyEqualityToABMixin< ViolationsComputationBMixin< ActiveSetDeterminationBMixin< BodyGIMixin< BoundsBMixin< TaskBase > > > > >, humoto::constraints::CopyEqualityToABMixin< ViolationsComputationB0Mixin< ActiveSetDeterminationBMixin< BodyIMixin< BoundsB0Mixin< TaskBase > > > > >, humoto::constraints::CopyEqualityToABMixin< ViolationsComputationBMixin< ActiveSetDeterminationBMixin< BodyASMixin< BoundsBMixin< TaskBase > > > > >, humoto::constraints::CopyEqualityToABMixin< ViolationsComputationBMixin< ActiveSetDeterminationBMixin< BodyIMixin< BoundsBMixin< TaskBase > > > > >, humoto::constraints::CopyEqualityToABMixin< ViolationsComputationB0Mixin< ActiveSetDeterminationBMixin< BodyASMixin< BoundsB0Mixin< TaskBase > > > > >, humoto::constraints::CopyEqualityToABMixin< ViolationsComputationB0Mixin< ActiveSetDeterminationBMixin< BodyAMixin< BoundsB0Mixin< TaskBase > > > > >, and humoto::constraints::CopyEqualityToABMixin< ViolationsComputationB0Mixin< ActiveSetDeterminationBMixin< BodyGIMixin< BoundsB0Mixin< TaskBase > > > > >.
Definition at line 487 of file constraints_base.h.
|
inlinevirtualinherited |
Set constraints.
[in,out] | container | new constraints |
[in] | constraints_offset | first row offset |
Reimplemented from humoto::constraints::ConstraintsBase.
Definition at line 615 of file constraints_base.h.
|
inlinevirtualinherited |
Set constraints.
[in,out] | container | new constraints |
[in] | constraints_offset | first row offset |
Reimplemented from humoto::constraints::ConstraintsBase.
Definition at line 648 of file constraints_base.h.
|
inlinevirtualinherited |
Determine active set given a solution vector.
[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 1115 of file constraints_mixins.h.
|
inlineprotectedvirtualinherited |
Reimplemented from humoto::config::CommonConfigurableBase< true >.
|
protectedpure virtualinherited |
Form the task.
[in] | sol_structure | structure of the solution |
[in] | model_base | model |
[in] | control_problem | control problem |
Implemented in humoto::TaskInfeasibleInequality, humoto::TaskZeroSelectedVariables, humoto::pepper_ik::TaskBaseOrientation< FIXED_WHEELS|ROOT_PLANAR >, humoto::pepper_ik::TaskBaseCoMTracking< FIXED_WHEELS|ROOT_PLANAR >, humoto::pepper_ik::TaskBaseCoMTracking< t_features >, humoto::pepper_ik::TaskBaseOrientation< t_features >, humoto::pepper_ik::TaskTagOrientation< t_features >, humoto::TaskZeroVariables, humoto::pepper_ik::TaskTagPose3Dof< t_features >, humoto::pepper_ik::TaskTagAngularVelocity< t_features >, humoto::pepper_ik::TaskTagCompleteVelocity< t_features >, humoto::pepper_ik::TaskTagPose< t_features >, humoto::pepper_ik::TaskBodyCoMTracking< t_features >, humoto::pepper_ik::TaskJointsReference< t_features >, humoto::wpg04::TaskFootstepBounds, humoto::wpg04::TaskCoPVelocity, humoto::wpg04::TaskCoMVelocity, humoto::wpg04::TaskTerminalConstraint, humoto::wpg04::TaskCoPBounds, humoto::pepper_ik::TaskFixArms< t_features >, humoto::pepper_ik::TaskFixHead< t_features >, humoto::pepper_mpc::TaskBaseJerkMinimization, humoto::pepper_mpc::TaskBasePositionReference, humoto::pepper_mpc::TaskBaseVelocityReference, humoto::pepper_mpc::TaskCoPCentering, humoto::pepper_ik::TaskJointsBounds< t_features >, humoto::pepper_mpc::TaskBaseAccelerationBounds, humoto::pepper_mpc::TaskBaseVelocityBounds, humoto::pepper_mpc::TaskBodyPositionBounds, humoto::pepper_mpc::TaskCoPPositionBounds, and humoto::pepper_mpc::TaskBodyPositionReference.
|
inlineprotectedinherited |
|
inlineprotectedinherited |
|
inlineprotectedinherited |
Compute 'A^T * A' for general equality constaints and save or add the result to H.
[in,out] | H | left lower triangular part of the result. |
Definition at line 935 of file constraints_mixins.h.
|
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.
[in,out] | H | left lower triangular part of the result. |
[in,out] | g | result |
Reimplemented in humoto::constraints::ConstraintsIB0< TaskBase >, humoto::constraints::ConstraintsIB< TaskBase >, humoto::constraints::ConstraintsGIB0< TaskBase >, humoto::constraints::ConstraintsGIB< TaskBase >, humoto::constraints::ConstraintsASB0< TaskBase >, humoto::constraints::ConstraintsASB< TaskBase >, humoto::constraints::ConstraintsAB0< TaskBase >, and humoto::constraints::ConstraintsAB< TaskBase >.
Definition at line 436 of file constraints_base.h.
|
inlineprotectedvirtualinherited |
Return the default name of a configuration node corresponding to this class.
Implements humoto::config::CommonConfigurableBase< true >.
|
inlineinherited |
Computes location of the copied constraints in a container and verifies their consistency.
[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 |
Definition at line 262 of file constraints_base.h.
|
inlineinherited |
|
inlineinherited |
|
inlineinherited |
Get gains for each element in simple objective.
Definition at line 963 of file constraints_mixins.h.
|
inlineinherited |
Get gains for each element in simple objective.
Definition at line 969 of file constraints_mixins.h.
|
inlineinherited |
|
inlineinherited |
|
inlineinherited |
Get lower bounds (lb/ub vectors from 'lb <= A*x <= ub').
Definition at line 254 of file constraints_mixins.h.
|
inlineinherited |
Get lower bounds (lb/ub vectors from 'lb <= A*x <= ub').
Definition at line 260 of file constraints_mixins.h.
|
inlinevirtualinherited |
Returns number of constraints in the task.
Implements humoto::constraints::ContainerBase.
Definition at line 866 of file constraints_mixins.h.
|
protectedpure virtualinherited |
Get number of entries in the corresponding configuration node.
Implemented in humoto::ConfigurableOptimizationProblem.
|
inlineinherited |
Returns number of variables in the task.
Definition at line 215 of file constraints_base.h.
|
inlineinherited |
Compute A(i,:) * vector.
[in] | i | row index |
[in] | vector | vector |
Definition at line 1010 of file constraints_mixins.h.
|
inlinevirtualinherited |
Returns type of the constraints.
Implements humoto::constraints::ConstraintsBase.
Definition at line 636 of file constraints.h.
|
inlineprotectedvirtualinherited |
Initialize active set guess with defaults.
[in] | sol_structure | structure of the solution |
[in] | model_base | model |
[in] | control_problem | control problem |
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.
|
inlineinherited |
Check properties of the constriaints.
Definition at line 523 of file constraints_base.h.
|
inlineinherited |
Check properties of the constriaints.
Definition at line 529 of file constraints_base.h.
|
inlineinherited |
Check properties of the constriaints.
Definition at line 535 of file constraints_base.h.
|
inlineinherited |
|
inlineprotectedvirtualinherited |
Log body.
[in,out] | logger | logger |
[in] | parent | parent |
[in] | name | name |
Reimplemented from humoto::constraints::BodyIMixin< BoundsLMixin< TaskBase > >.
Definition at line 922 of file constraints_mixins.h.
|
inlineprotectedvirtualinherited |
Log bounds.
[in,out] | logger | logger |
[in] | parent | parent |
[in] | name | name |
Implements humoto::constraints::ContainerBase.
Definition at line 240 of file constraints_mixins.h.
|
inlineprotectedvirtualinherited |
Log task.
[in,out] | logger | logger |
[in] | parent | parent |
[in] | name | name |
Implements humoto::TaskBase.
|
inlineprotectedinherited |
By default the task is assumed to be modified. Use this function to mark it as unmodified to avoid unnecessary recomputations.
|
inlineinherited |
|
inlineinherited |
|
inlineinherited |
|
inlineinherited |
|
inlineinherited |
|
inlineinherited |
|
inlineinherited |
|
inlineprotectedinherited |
Initialize constraints.
[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.
|
inlineprotectedvirtualinherited |
Initialize I and gains.
[in] | number_of_constraints | number of constraints |
[in] | initialize_matrices | initialize matrices using defaults |
Reimplemented from humoto::constraints::BodyIMixin< BoundsLMixin< TaskBase > >.
Definition at line 912 of file constraints_mixins.h.
|
inlineprotectedvirtualinherited |
Reset bounds of constraints (b, lb, ub)
[in] | number_of_constraints | number of constraints |
[in] | initialize_matrices | initialize matrices using defaults |
Implements humoto::constraints::ContainerBase.
Definition at line 226 of file constraints_mixins.h.
|
inlineprotectedvirtualinherited |
Reimplemented from humoto::TaskBase.
|
inlineinherited |
|
inlinevirtualinherited |
|
inlineprotectedinherited |
Set number of variables.
[in] | number_of_variables | number of variables |
Definition at line 142 of file constraints_base.h.
|
inlineinherited |
|
inlineinherited |
|
inlineinherited |
|
inlineinherited |
|
inlineinherited |
|
inlineinherited |
|
protectedinherited |
|
staticprotectedinherited |
|
protectedinherited |
|
protectedinherited |
Definition at line 746 of file constraints_mixins.h.
|
protectedinherited |
Definition at line 894 of file constraints_mixins.h.
|
protectedinherited |
Definition at line 210 of file constraints_mixins.h.
|
protectedinherited |
Definition at line 120 of file constraints_base.h.