FWIK: Multi-Waypoint IK Selection via Lookahead Graph Search
Abstract
An ordered sequence of end-effector poses can give a redundant robot arm multiple valid joint configurations at each waypoint. Inverse kinematics (IK) computes these configurations. Choosing a configuration only for the next waypoint can leave the arm poorly placed for later waypoints. This may increase planned motion time or cause a later planning failure. This paper presents Future-Window Inverse Kinematics (FWIK), an online method that selects IK solutions by considering a small window of future waypoints. FWIK generates several IK candidates, connects them in a layered joint-space graph, and ranks candidate paths with a simple motion-time estimate. A learned model removes paths whose transitions are likely to cause self-collision. A standard MoveIt 2 planner then checks the next-waypoint IK goals from the remaining paths in ranked order, and the first goal that yields a valid trajectory is selected for execution. We evaluate FWIK in simulation on two 7-DoF manipulators, the Franka Emika Panda and the KUKA LBR iiwa. Each method-planner setting contains five repetitions of 100 sequences with 50 waypoints. Across Pilz, RRT-Connect, CHOMP, and STOMP, FWIK completes 96.8-100% of sequences and gives the shortest planned trajectory duration in all eight robot-planner settings. Its mean duration is 12.8-13.1% lower than STAMPEDE, 22.5-25.6% lower than IKLink, and 27.5-37.2% lower than retry-based TRAC-IK. The results show that a small future window can improve sequence completion and reduce planned motion time while leaving final trajectory validation to the motion planner.
Figures & tables
| Robot | Planner | Method | Sequence Success (%) | Waypoint Completion (%) | Decision Time (s/sequence) | Planned Duration (s/sequence) |
| Franka Emika Panda | Pilz PTP | IKLink | 10.4 3.4 | 40.06 3.92 | 3.84 0.24 | 95.24 4.29 |
| STAMPEDE | 21.6 3.6 | 57.48 2.13 | 3.89 2.77 | 84.49 2.67 | ||
| TRAC-IK | 9.6 2.1 | 41.79 2.61 | 0.11 0.02 | 101.40 4.80 | ||
| FWIK | 96.8 2.0 | 98.19 1.26 | 1.60 0.12 | 73.52 1.61 | ||
| RRT-Connect | IKLink | 14.2 4.4 | 43.71 3.19 | 3.77 0.28 | 96.24 4.16 | |
| STAMPEDE | 19.8 2.3 | 54.88 1.04 | 3.51 1.90 | 84.60 2.41 |
| Planner | ||||
| EC | no EC | EC ∗ | no EC | |
| Franka Panda | ||||
| Pilz PTP | 96.8% / 73.52 | 22.6% / 73.22 | 92.0% / 77.34 | 18.2% / 77.22 |
| RRT-Connect | 100.0% / 73.54 | 100.0% / 73.68 | 93.6% / 77.43 | 100.0% / 77.79 |
| CHOMP | 100.0% / 73.48 | 96.2% / 73.37 | 95.8% / 77.35 | 95.6% / 77.43 |
| STOMP | 100.0% / 73.53 | 80.6% / 73.43 | 93.4% / 77.40 | 82.0% / 77.45 |
Inverse Kinematics
Inverse kinematics maps desired robot or articulated-body motions to joint configurations while handling constraints, redundancy, and multiple solutions.
See all 45 papers