Efficient Probabilistic Collision Detection for Non-Gaussian Noise Distributions
This enables more efficient and accurate motion planning for robots in uncertain environments, though it is incremental as it builds on existing probabilistic collision detection.
The paper tackles the problem of computing collision probability bounds for objects with non-Gaussian positional uncertainties, such as from depth sensors, resulting in 10x tighter bounds and 3x faster running time compared to prior methods.
We present an efficient algorithm to compute tight upper bounds of collision probability between two objects with positional uncertainties, whose error distributions are represented with non-Gaussian forms. Our approach can handle noisy datasets from depth sensors, whose distributions may correspond to Truncated Gaussian, Weighted Samples, or Truncated Gaussian Mixture Model. We derive tight probability bounds for convex shapes and extend them to non-convex shapes using hierarchical representations. We highlight the benefits of our approach over prior probabilistic collision detection algorithms in terms of tighter bounds ($10$x) and improved running time ($3$x). Moreover, we use our tight bounds to design an efficient and accurate motion planning algorithm for a 7-DOF robot arm operating in tight scenarios with sensor and motion uncertainties.