Anytime Global Tensor Motion Planning
Organizations: Department of Computer Science, Purdue University, USA. · College of Engineering and Computer Science, VinUniversity, Hanoi, Vietnam. · Intelligent Autonomous Systems Lab, TU Darmstadt, Germany.
Abstract
Global Tensor Motion Planning (GTMP) solves motion planning with batched tensor operations over a layered multipartite graph. We generalize GTMP so that adjacent-layer edges are realized by any black-box local planner (e.g., linear interpolation, splines, sampling-based planning, trajectory optimization, or generative sampling). We provide two anytime policies on top of this generalization: Anytime GTMP with random restarts at a fixed budget, which covers every homotopy class almost surely, and AO-GTMP with informed expansion with growing budgets, which converges to the optimal cost. We prove that a single sampled graph covers every endpoint-fixed homotopy class admitting a -clear representative of bounded length. We also prove that additional samples per layer reduce the per-layer miss probability exponentially, whereas stronger local planners reduce the required layer count only sublinearly. On manipulation benchmarks the method matches state-of-the-art performance, and on 2D navigation it returns batches of topologically diverse solutions, while the informed baselines concentrate on one or two classes.
Figures & tables
| Planner | bookshelf small | bookshelf tall | bookshelf thin | table pick | table under pick | box | cage | |
|---|---|---|---|---|---|---|---|---|
| Panda | FCIT* | 100% (4.6) | 100% (4.6) | 100% (4.5) | 99% (4.6) | 100% (5.7) | 100% (4.2) | 99% (7.4) |
| AORRTC | 100% ( 4.2 ) | 100% ( 4.4 ) | 100% ( 4.2 ) | 100% ( 4.4 ) | 100% (4.7) | 100% ( 3.9 ) | 100% ( 4.9 ) | |
| BIT* | 0% ( ) | 52% ( ) | 98% ( ) | 98% ( ) | 100% (5.6) | 1% ( ) | 20% ( ) | |
| RRT* | 32% ( ) | 29% ( ) | 34% ( ) | 48% ( ) | 37% ( ) | 24% ( ) | 0% ( ) | |
| AO-GTMP (SEV) | 100% (4.4) | 100% (4.5) | 100% (4.4) | 99% (4.5) | 100% (5.8) | 100% (4.2) | 100% (6.8) | |
| AO-GTMP (RRTC) | 92% (4.3) | 97% ( 4.4 ) | 100% ( 4.2 ) | 100% ( 4.4 ) | 100% ( 3.7 ) | 100% ( 3.9 ) | 96% (6.3) |
Motion Planning
Motion planning finds safe, feasible paths and trajectories for robots and vehicles amid geometric, dynamic, and task constraints.
See all 405 papers