The hierarchical Newton's method for numerically stable prioritized dynamic control

Kai Pfeiffer,Adrien Escande,Pierre Gergondet,Abderrahmane Kheddar
2023-03-08
Abstract:This work links optimization approaches from hierarchical least-squares programming to instantaneous prioritized whole-body robot control. Concretely, we formulate the hierarchical Newton's method which solves prioritized non-linear least-squares problems in a numerically stable fashion even in the presence of kinematic and algorithmic singularities of the approximated kinematic constraints. These results are then transferred to control problems which exhibit the additional variability of time. This is necessary in order to formulate acceleration based controllers and to incorporate the second order dynamics. However, we show that the Newton's method without complicated adaptations is not appropriate in the acceleration domain. We therefore formulate a velocity based controller which exhibits second order proportional derivative convergence characteristics. Our developments are verified in toy robot control scenarios as well as in complex robot experiments which stress the importance of prioritized control and its singularity resolution.
Robotics,Optimization and Control
What problem does this paper attempt to address?
The problem that this paper attempts to solve is, in robot control, how to solve the prioritized nonlinear least - squares problem in a numerically stable manner in the presence of kinematic and algorithmic singularities, and apply it to immediate - priority whole - body robot control. Specifically, the paper proposes the Hierarchical Newton’s Method, which can maintain numerical stability when dealing with robot control problems and work effectively even in the face of kinematic and algorithmic singularities. In addition, the paper also explores how to adapt this optimization method to control problems in the time domain, especially how to design a velocity - based controller to simulate the second - order proportional - derivative (PD) convergence characteristics, thereby overcoming problems encountered when directly applying Newton’s method in the acceleration domain, such as low - frequency oscillation and under - damping phenomena. Through these methods, the paper aims to provide an effective solution that can handle task - priority conflicts and singularity problems arising in complex robot experiments.