Asymptotically optimal planning under piecewise-analytic constraints

Abstract

We present the first asymptotically optimal algorithm for motion planning problems with piecewise-analytic differential constraints, like manipulation or rearrangement planning. This class of problems is characterized by the presence of differential constraints that are local in nature: a robot can only move an object once the object has been grasped. These constraints are not analytic and thus cannot be addressed by standard differentially constrained planning algorithms. We demonstrate that, given the ability to sample from the locally reachable subset of the configuration space with positive probability, we can construct random geometric graphs that contain optimal plans with probability one in the limit of infinite samples. This approach does not require a hand-coded symbolic abstraction. We demonstrate our approach in simulation on a simple manipulation planning problem, and show it generates lower-cost plans than a sequential task and motion planner.

Publication
In Workshop on the Algorithmic Foundations of Robotics (WAFR).
Date