Skip to Main content Skip to Navigation
Journal articles

Hierarchical quadratic programming: Fast online humanoid-robot motion generation

Adrien Escande 1 Nicolas Mansard 2 Pierre-Brice Wieber 3 
2 LAAS-GEPETTO - Équipe Mouvement des Systèmes Anthropomorphes
LAAS - Laboratoire d'analyse et d'architecture des systèmes
3 BIPOP - Modelling, Simulation, Control and Optimization of Non-Smooth Dynamical Systems
Inria Grenoble - Rhône-Alpes, LJK - Laboratoire Jean Kuntzmann, Grenoble INP - Institut polytechnique de Grenoble - Grenoble Institute of Technology
Abstract : Hierarchical least-square optimization is often used in robotics to inverse a direct function when multiple incompatible objectives are involved. Typical examples are inverse kinematics or dynamics. The objectives can be given as equalities to be satisfied (e.g. point-to-point task) or as areas of satisfaction (e.g. the joint range). This two-part paper proposes a complete solution to resolve multiple least-square quadratic problems of both equality and inequality constraints ordered into a strict hierarchy. Our method is able to solve a hierarchy of only equalities ten time faster than the classical method and can consider inequalities at any level while running at the typical control frequency on whole-body size problems. This generic solver is used to resolve the redundancy of humanoid robots while generating complex movements in constrained environment. In the first part, we establish the mathematical bases underlying the hierarchical problem and propose a dedicated solver. When only equalities are involved, the solver amounts to the classical solution used to handle redundancy in inverse kinematics in a far more efficient way. It is able to handle inequalities at any priority levels into a single resolution scheme, which avoids the high number of iterations encountered with cascades of solvers. A simple example is given to illustrate the interest of our approach. In the second part, we detail the implementation of the solver and its application to inverse kinematics. In particular, we explicit the solver complexity and prove the continuity and the stability of the resulting control laws. Finally, we experimentally demonstrate its efficiency in the context of generating robot motions.
Document type :
Journal articles
Complete list of metadata

Cited literature [22 references]  Display  Hide  Download
Contributor : Nicolas Mansard Connect in order to contact the contributor
Submitted on : Tuesday, December 11, 2012 - 4:00:37 PM
Last modification on : Tuesday, July 5, 2022 - 8:38:42 AM
Long-term archiving on: : Tuesday, March 12, 2013 - 2:45:13 AM


Files produced by the author(s)



Adrien Escande, Nicolas Mansard, Pierre-Brice Wieber. Hierarchical quadratic programming: Fast online humanoid-robot motion generation. The International Journal of Robotics Research, SAGE Publications, 2014, 33 (7), pp.1006-1028. ⟨10.1177/0278364914521306⟩. ⟨hal-00751924⟩



Record views


Files downloads