Mirror-Descent Inverse Kinematics for Box-constrained Joint Space

TL;DR

This paper introduces a mirror descent-based inverse kinematics solver with box constraints that improves stability and speed for humanoid robot gait control, outperforming traditional Jacobian methods.

Contribution

It integrates mirror descent with Jacobian-based IK to handle joint constraints explicitly, introduces an epsilon-clamping heuristic, and applies acceleration for faster convergence.

Findings

Achieved more stable and fast tracking performance.

Reduced computational cost enabling real-time gait control.

Enhanced stability in humanoid robot movements.

Abstract

To control humanoid robots, the reference pose of end effector(s) is planned in task space, then mapped into the reference joints by IK. By viewing that problem as approximate quadratic programming (QP), recent QP solvers can be applied to solve it precisely, but iterative numerical IK solvers based on Jacobian are still in high demand due to their low computational cost. However, the conventional Jacobian-based IK usually clamps the obtained joints during iteration according to the constraints in practice, causing numerical instability due to non-smoothed objective function. To alleviate the clamping problem, this study explicitly considers the joint constraints, especially the box constraints in this paper, inside the new IK solver. Specifically, instead of clamping, a mirror descent (MD) method with box-constrained real joint space and no-constrained mirror space is integrated with the Jacobian-based IK, so-called MD-IK. In addition, to escape local optima nearly on the boundaries of constraints, a heuristic technique, called $\epsilon$-clamping, is implemented as margin in software level. Finally, to increase convergence speed, the acceleration method for MD is integrated assuming continuity of solutions at each time. As a result, the accelerated MD-IK achieved more stable and enough fast tracking performance compared to the conventional IK solvers. The low computational cost of the proposed method mitigated the time delay until the solution is obtained in real-time humanoid gait control, achieving a more stable gait.