cs.RONov 8, 2026

Large-Scale Hierarchical Decision-Making in Robot Control via ADMM

Authors: Kai Pfeiffer, Jia Wang, Gordon Owusu Boateng, Yuquan Wang, Vincent Bonnet, Abderrahmane Kheddar

Organizations: AIAT, Xi’an Jiaotong-Liverpool University, China. · X Square Robot, China. · IPAL, CNRS, Singapore · LAAS-CNRS, University of Toulouse, France. · 

Abstract

Sparse hierarchical nonlinear programming (SH-NLP) based on the ℓ0\ell_0-norm provides a powerful framework for integrated, efficient hierarchical decision-making in robot kinematic control, for example in the presence of a large set of possible end-effector candidate locations. While Sequential Sparse Hierarchical Quadratic Programming (S-SHQP) with interior-point method based SHQP sub-problem solvers exploit the hierarchical, sparse structure of such problems, they are less amenable to effective warm-starting between subsequent, coherent control steps. In this work, we formulate an Alternating Direction Method of Multipliers (ADMM) to efficiently solve related SHQP sub-problems. We introduce efficient substitutions for auxiliary variables representing ℓ0\ell_0-norm surrogates. The solver efficiently handles separable decision functions by evaluating linear algebra expressions in the appropriate order. Results in large-scale kinematic and dynamic control show reduced computation times of up to 23.5% compared with a structure-exploiting interior-point method in low- to moderate-accuracy regimes. Furthermore, hierarchical decision-making is extended to whole-body dynamic control for humanoid walking, where the need for high-accuracy solutions is highlighted.

Figures & tables

Explore similar work

CardsList
  1. ACLM: ADMM-Based Distributed Model Predictive Control for Collaborative Loco-Manipulation

    Mar 7, 2026Ziyi Zhou, Pengyuan Shu, Ruize Cao +2Model Predictive ControlMulti-Robot Coordination

  2. ElastiQP: An Always-Feasible QP Solver for Constrained Robot Control

    Sep 16, 2026Daniel Morton, Jon Arrizabalaga, Zachary Manchester +1Robotic ControlConstrained Optimization