Real-Time Conformal-Seeded Hybrid Inverse Kinematics for Offset Redundant Manipulators
Organizations: VinRobotics, Hanoi 100000, Vietnam · School of Electrical and Electronic Engineering, Nanyang Technological University 639798, Singapore · VinRobotics JSC, Hanoi 100000, Vietnam · Center for AI Research (CAIR), VinUniversity, Hanoi 100000, Vietnam
Abstract
This paper presents a conformal-seeded hybrid strategy for solving inverse kinematics of offset, redundant 7-DoF robot arms of the humanoid class. Analytical inverse kinematics (AIK) provides closed-form solutions with very low computational cost. However, for offset kinematic structures, the exact closed-form solution is generally unavailable, and practical AIK must rely on an approximate or simplified kinematic model. In contrast, numerical inverse kinematics (NIK) can achieve high-precision solutions on the full kinematic model. However, its convergence is highly sensitive to initialization. To overcome these limitations, we propose a two-stage hybrid inverse kinematics framework with conformal-calibrated seed selection. First, an approximate analytical model efficiently enumerates a finite set of candidate joint solutions. Second, we rank these candidates using a lightweight learned predictor of post-refinement difficulty, wrapped by split-conformal prediction into a calibrated upper bound that serves as the selection score. The best-ranked seed is then refined using a Levenberg-Marquardt solver on the full kinematic model. The proposed method combines fast candidate generation, learned seed ranking with a calibrated difficulty bound, and accurate numerical refinement, achieving real-time performance of less than 40us and a success rate of 100% in our evaluation on reachable targets. We validate the approach through large-scale stochastic simulation across the workspace and experimental demonstrations with motion planning on a humanoid robot arm. Demonstration videos are available at https://youtu.be/aeiBmw1XRbw.
Figures & tables
| Link | (rad) | (m) | (rad) | (m) |
|---|---|---|---|---|
| 1 | 0 | -0.20624 | ||
| 2 | 0 | -0.009 | ||
| 3 | 0 | -0.2247 | ||
| 4 | 0 | 0 | ||
| 5 | 0 | -0.2196 | ||
| 6 | 0 | 0 |
| Methods | Success rate (%) | Exec. time ( ) | Pos. error ( ) | Rot. error ( ) | ||
|---|---|---|---|---|---|---|
| AIK ( 3 ) | 100 | 0.227 | 9640 | 2520 | ||
| NIK ( 6 ) | 65.37 | 283.8 | 285 | 489 | ||
| KDL-LMA [ 14 ] | 12.00 a | 154.1 | 2.8 | 1649 | ||
| KDL-NR-JL [ 14 ] | 21.67 | 780.35 | 0.03 | 0.4 | ||
| TracIK [ 13 ] | 99.38 | 728.70 | 2.9 | 4.2 | ||
| PyRoki [ 12 ] | 80.45 | 448.0 | 6586 | 16.3 | ||
| Ranking score | Success rate (%) @ | Success rate (%) @ | |
|---|---|---|---|
| Raw | 99.93 | 99.95 | |
| Floored | 99.38 | 99.94 | |
| CS-HIK, | 99.93 | 99.95 | |
| Raw | \color[rgb]{0,0,0}\pi/9 | 99.97 | 100 |
| Floored | 99.26 | 99.99 | |
| CS-HIK, | 99.97 | 100 |
Inverse Kinematics
Inverse kinematics maps desired robot or articulated-body motions to joint configurations while handling constraints, redundancy, and multiple solutions.
See all 40 papers