Safe motion planning with environment uncertainty
- URL: http://arxiv.org/abs/2305.06004v1
- Date: Wed, 10 May 2023 09:29:41 GMT
- Title: Safe motion planning with environment uncertainty
- Authors: Antony Thomas, Fulvio Mastrogiovanni, Marco Baglietto
- Abstract summary: We present an approach for safe motion planning under robot state and environment uncertainties.
We first develop an approach that accounts for the landmark uncertainties during robot localization.
We then extend the state-of-the-art by computing an exact expression for the collision probability.
- Score: 1.4824891788575418
- License: http://creativecommons.org/licenses/by/4.0/
- Abstract: We present an approach for safe motion planning under robot state and
environment (obstacle and landmark location) uncertainties. To this end, we
first develop an approach that accounts for the landmark uncertainties during
robot localization. Existing planning approaches assume that the landmark
locations are well known or are known with little uncertainty. However, this
might not be true in practice. Noisy sensors and imperfect motions compound to
the errors originating from the estimate of environment features. Moreover,
possible occlusions and dynamic objects in the environment render imperfect
landmark estimation. Consequently, not considering this uncertainty can wrongly
localize the robot, leading to inefficient plans. Our approach thus
incorporates the landmark uncertainty within the Bayes filter estimation
framework. We also analyze the effect of considering this uncertainty and
delineate the conditions under which it can be ignored. Second, we extend the
state-of-the-art by computing an exact expression for the collision probability
under Gaussian distributed robot motion, perception and obstacle location
uncertainties. We formulate the collision probability process as a quadratic
form in random variables. Under Gaussian distribution assumptions, an exact
expression for collision probability is thus obtained which is computable in
real-time. In contrast, existing approaches approximate the collision
probability using upper-bounds that can lead to overly conservative estimate
and thereby suboptimal plans. We demonstrate and evaluate our approach using a
theoretical example and simulations. We also present a comparison of our
approach to different state-of-the-art methods.
Related papers
- Score Matching-based Pseudolikelihood Estimation of Neural Marked
Spatio-Temporal Point Process with Uncertainty Quantification [59.81904428056924]
We introduce SMASH: a Score MAtching estimator for learning markedPs with uncertainty quantification.
Specifically, our framework adopts a normalization-free objective by estimating the pseudolikelihood of markedPs through score-matching.
The superior performance of our proposed framework is demonstrated through extensive experiments in both event prediction and uncertainty quantification.
arXiv Detail & Related papers (2023-10-25T02:37:51Z) - PRISM: Probabilistic Real-Time Inference in Spatial World Models [52.878769723544615]
PRISM is a method for real-time filtering in a probabilistic generative model of agent motion and visual perception.
The proposed solution runs at 10Hz real-time and is similarly accurate to state-of-the-art SLAM in small to medium-sized indoor environments.
arXiv Detail & Related papers (2022-12-06T13:59:06Z) - Case Studies for Computing Density of Reachable States for Safe
Autonomous Motion Planning [8.220217498103313]
Density of the reachable states can help understand the risk of safety-critical systems.
Recent work provides a data-driven approach to compute the density distribution of autonomous systems' forward reachable states online.
In this paper, we study the use of such approach in combination with model predictive control for verifiable safe path planning under uncertainties.
arXiv Detail & Related papers (2022-09-16T17:38:24Z) - Uncertainty estimation of pedestrian future trajectory using Bayesian
approximation [137.00426219455116]
Under dynamic traffic scenarios, planning based on deterministic predictions is not trustworthy.
The authors propose to quantify uncertainty during forecasting using approximation which deterministic approaches fail to capture.
The effect of dropout weights and long-term prediction on future state uncertainty has been studied.
arXiv Detail & Related papers (2022-05-04T04:23:38Z) - Trajectory Forecasting from Detection with Uncertainty-Aware Motion
Encoding [121.66374635092097]
Trajectories obtained from object detection and tracking are inevitably noisy.
We propose a trajectory predictor directly based on detection results without relying on explicitly formed trajectories.
arXiv Detail & Related papers (2022-02-03T09:09:56Z) - Dense Uncertainty Estimation via an Ensemble-based Conditional Latent
Variable Model [68.34559610536614]
We argue that the aleatoric uncertainty is an inherent attribute of the data and can only be correctly estimated with an unbiased oracle model.
We propose a new sampling and selection strategy at train time to approximate the oracle model for aleatoric uncertainty estimation.
Our results show that our solution achieves both accurate deterministic results and reliable uncertainty estimation.
arXiv Detail & Related papers (2021-11-22T08:54:10Z) - Exact and Bounded Collision Probability for Motion Planning under
Gaussian Uncertainty [1.3535770763481902]
We present an approach for computing the collision probability under Gaussian distributed motion.
The collision condition is formulated as the distance between ellipsoids.
We provide a tight upper bound that can be computed much faster during online planning.
arXiv Detail & Related papers (2021-10-12T20:45:18Z) - An Uncertainty Estimation Framework for Probabilistic Object Detection [5.83620245905973]
We introduce a new technique that combines two popular methods to estimate uncertainty in object detection.
Our framework employs deep ensembles and Monte Carlo dropout for approximating predictive uncertainty.
arXiv Detail & Related papers (2021-06-28T22:29:59Z) - An Integrated Localisation, Motion Planning and Obstacle Avoidance
Algorithm in Belief Space [1.3535770763481902]
Noisy sensors and actuation errors compound to the errors introduced while estimating features of the environment.
We present a novel approach to incorporate these uncertainties for robot state estimation.
We compute the probability of collision pertaining to the estimated robot configurations.
arXiv Detail & Related papers (2021-01-27T17:47:45Z) - Localization Uncertainty Estimation for Anchor-Free Object Detection [48.931731695431374]
There are several limitations of the existing uncertainty estimation methods for anchor-based object detection.
We propose a new localization uncertainty estimation method called UAD for anchor-free object detection.
Our method captures the uncertainty in four directions of box offsets that are homogeneous, so that it can tell which direction is uncertain.
arXiv Detail & Related papers (2020-06-28T13:49:30Z)
This list is automatically generated from the titles and abstracts of the papers in this site.
This site does not guarantee the quality of this site (including all information) and is not responsible for any consequences.