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 [Toulouse]
3 BIPOP - Modelling, Simulation, Control and Optimization of Non-Smooth Dynamical Systems
Inria Grenoble - Rhône-Alpes, LJK - Laboratoire Jean Kuntzmann, INPG - Institut National Polytechnique de Grenoble
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.
Type de document :
Article dans une revue
The International Journal of Robotics Research, sage, 2014, 33 (7), pp.1006-1028. 〈10.1177/0278364914521306〉
Liste complète des métadonnées

Littérature citée [22 références]  Voir  Masquer  Télécharger

Contributeur : Nicolas Mansard <>
Soumis le : mardi 11 décembre 2012 - 16:00:37
Dernière modification le : jeudi 2 février 2017 - 20:49:30
Document(s) archivé(s) le : mardi 12 mars 2013 - 02:45:13


Fichiers produits par l'(les) auteur(s)



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



Consultations de
la notice


Téléchargements du document