Track papers across labs, topics, and trends.
Search papers, labs, and topics across Lattice.
This paper introduces a sampling-based motion planning algorithm for robots operating under unknown, random disturbances, using chance constraints to ensure safety. The core idea is to learn a Wasserstein ambiguity tube from trajectory data, representing the evolution of the system's state distribution with high confidence. The algorithm then grows a probabilistically complete motion planning tree within this tube, and the use of lower-dimensional ambiguity tubes and a bandit-based validity checker improves scalability and performance.
Guaranteeing robot safety under uncertainty doesn't require knowing the disturbance distribution, thanks to a new algorithm that learns a "safe zone" from trajectory data.
We present a provably safe sampling-based motion planning algorithm for robotic systems affected by random disturbances of unknown distribution. We consider systems with linear or linearizable dynamics evolving in workspace with arbitrary-shaped obstacles subject to state and control constraints. Safety requirements are formulated as chance-constraints. Our approach leverages data from trajectories of the system to learn a Wasserstein ambiguity tube, i.e., a sequence of ambiguity sets, which contains the trajectory of the system's state distribution with high confidence. This ambiguity tube is then used in a probabilistically complete algorithm to grow a sampling-based motion planning tree that respects the constraints of the problem. We show that learning several lower-dimensional ambiguity tubes instead of a single high-dimensional one effectively reduces the conservatism and boosts scalability. Additionally, we design an efficient bandit-based validity checker that remarkably increases the empirical performance of our approach without sacrificing probabilistic completeness. Case studies show our algorithm finds valid plans in cluttered environments under strict safety thresholds, outperforming state-of-the-art methods.