Bayesian Inferential Motion Planning Using Heavy-Tailed Distributions

Ali Vaziri, Iman Askari, Huazhen Fang · 2025

Read Bayesian Inferential Motion Planning Using Heavy-Tailed Distributions by Ali Vaziri, Iman Askari, Huazhen Fang (2025) in the Tower of Babel, a free online library of public-domain works preserved in clean, searchable text. No sign-up. The full text is served as a plain-text file at a predictable URL, where text is present: https://antarctic-labs.com/tower-of-babel/arxiv-2503-22030.txt.

Introduction

Ali Vaziri, Iman Askari, and Huazhen Fang planned robot motion through probability in a 2025 paper. Bayesian motion planning treats a good path as something to infer from goals and constraints. Standard versions explore with bell-curve distributions, which rarely sample the low-probability corners where the best plans may hide. The authors swap in heavy-tailed Student-t distributions, whose fat tails reach those corners.

Their method smooths sampled plans in a single sequential pass, with a known Gaussian smoother as a special case. Tests on self-driving car scenarios beat that Gaussian method on plan quality, sampling efficiency, and respect for constraints. The authors suggest heavy tails could improve probabilistic decision-making across robotics, wherever rare regions hold the best answers.

Catalog record

CREATORAli Vaziri, Iman Askari, Huazhen Fang
YEAR2025
COLLECTIONPAPERS
FORMATTXT
FILE SIZE32 KB
VERSION1.0
LICENSEhttp://creativecommons.org/licenses/by/4.0/
RIGHTSCC BY
SOURCEarXiv

Source: https://arxiv.org/abs/2503-22030

Browse the full library · About the Tower of Babel

Full text

The opening of the work, from the library's hosted text:

Bayesian Inferential Motion Planning Using Heavy-Tailed Distributions Ali Vaziri, Iman Askari, Huazhen Fang Abstract Robots rely on motion planning to navigate safely and efficiently while performing various tasks. In this paper, we investigate motion planning through Bayesian inference, where motion plans are inferred based on planning objectives and constraints. However, existing Bayesian motion planning methods often struggle to explore low-probability regions of the planning space, where high-quality plans may reside. To address this limitation, we propose the use of heavy-tailed distributions—specifically, Student’s- t t distributions—to enhance probabilistic inferential search for motion plans. We develop a novel sequential single-pass smoothing approach that integrates Student’s- t t distribution with Monte Carlo sampling. A special case of this approach is ensemble Kalman smoothing, which depends on short-tailed Gaussian distributions. We validate the proposed approach through simulations in autonomous vehicle motion planning, demonstrating its superior performance in planning, sampling efficiency, and constraint satisfaction compared to ensemble Kalman smoothing. While focused on motion planning, this work points to the broader potential of heavy-tailed distributions in enhancing probabilistic decision-making in robotics. I Introduction Robotics is one of the most enabling technologies nowadays to transform myriad industry sectors and enhance human life. Robots’ successful operation relies on various intelligent decision-making capabilities. Among them, motion planning is as foundational as it is flourishing, and the literature has presented many advances. Random sampling is a powerful tool for motion planning to search nonconvex, high-dimensional spaces. Rapidly exploring random tree (RRT) is a popular method in this regard, due to its straightforward design, wide applicability, and almost sure convergence to local optima [ 1 ] . It has inspired many variants, including kinodynamic RRT [ 2 ] for dynamic constraints, closed-loop RRT [ 3 ] , and \textrm{RRT}^{*} with optimality-aware design [ 4 , 5 ] . Other important algorithms include Dijkstra’s algorithm [ 6 ] , A* [ 7 ] , and potential field algorithms [ 8 , 9 ] . These methods, however, make limited use of dynamic models. Optimization-driven methods hence have gained growing importance, with their capability of including predictive models and operation constraints to improve the generation of motion plans [ 10 , 11 , 12 , 13 ] . A diversity of techniques, e.g., iLQR and NMPC [ 14 , 15 , 16 ] , have been studied in the literature. Yet, receding-horizon-constrained optimization at the core of these methods may require expensive computation, especially when facing highly nonlinear models or complex environments. Attempts to mitigate computation by introducing approximation will lead to performance loss. Bayesian inferential motion planning (BIMP) has recently attracted a growing interest due to its promise to address some complex problems. BIMP focuses on inferring the best motion plans using the planning objectives and constraints as the evidence within a Bayesian framework [ 17 , 18 ] . It establishes a prior probability for motion plans, considers the likelihood of achieving the planning objectives and satisfying constraints given these plans, and then applies Bayes’ rule to obtain the posterior probability of the plans. BIMP harnesses the power of probabilistic inference to offer multi-fold advantages. It allows to easily incorporate robot models into the predictive planning process and enables the use of a plentiful number of nonlinear state estimation for motion planning. Especially, Monte Carlo sampling-based inference has gained significant use. For example, the studies in [ 19 , 20 ] exploit particle filtering/smoothing and ensemble Kalman smoothing to estimate the trajectories for autonomous vehicles. What makes sampling-based BIMP even more appealing is its capability of tackling complicated problems. For example, motion planning with machine learning dynamic models is challenging due to its complex optimization landscapes, but well-designed sampling schemes can achieve remarkably high computational efficiency [ 18 , 20 ] . Further, the idea of Bayesian inference has shown effectiveness in dealing with various tricky problems in motion planning, e.g., probabilistic collision avoidance and uncertain or incomplete knowledge of the environment [ 21 ] . A key question for sampling-based BIMP is how to achieve high-efficiency search in probabilistic state spaces for high-quality motion plans . To address this question, the literature has introduced new sampling-based inference methods. In [ 18 ] , implicit particle filtering/smoothing seeks to concentrate sampling-based search within high-probability regions to improve both sampling efficiency and planning accuracy; in [ 20 ] , a sequential single-pass ensemble Kalman smoothing is used to speed up computation. For sampling-based search, a main challenge is that high-quality motion plans may lie in the less probable regions of the prior probability. Particle filtering/smoothing can partly handle the situation, yet demanding the use of many particles at more computational expenses. The challenge is realistically impactful for ensemble Kalman smoothing, as its dependence on Gaussian distribution assumptions would hold it back from searching broadly. Heavy-tailed distributions present a promise to address the above question. These distributions are characterized by non-exponentially bounded tails, which make a wide spectrum of decisions more probable in the motion planning context. If building upon this feature, probabilistic search can find out motion plans that look less probable in the prior but can increase the planning performance much. In this paper, we explore advancing BIMP with heavy-tailed distributions. Specifically, we consider Student’s- t distribution for the prior and likelihood in motion planning for autonomous vehicles and then in this setting, perform inference based on Monte Carlo sampling. This development leads to a sequential smoothing algorithm for BIMP, which takes a form similar to ensemble Kalman smoothing but shows significant improvement in both sample efficiency and planning performance for the challenging problem of BIMP with machine learning dynamic models for autonomous vehicles. We further reveal the connection of the proposed algorithm with motion planning based on NMPC. II BIMP Problem Setup In this section, we set up the BIMP problem for autonomous vehicle motion planning. Consider an ego vehicle (EV) represented by a nonlinear dynamic model: \displaystyle\bm{x}_{k+1}=f(\bm{x}_{k},\bm{u}_{k}), (1) where \bm{x} is the state including the position, heading angle, and velocity, and \bm{u} is the input including the acceleration and steering angle. In this paper, we specifically use a neural network dynamic model for f(\cdot,\cdot) as in [ 18 ] , leveraging its data-driven learning capability to grasp vehicle dynamics. This vehicle must move in such a way that \bm{x} tracks a reference \bm{r} , generated by a higher-level decision-making module, while its input \bm{u} follows \bm{s} . Some other so-called obstacle vehicles (OVs) are driving on the road, with their state denoted as \bm{x}_{k}^{\mathrm{OV},i} for i=1,2,\ldots,N_{O} , where N_{O} is the number of OVs. The EV must avoid colliding with the OVs, thus imposing the following constraint in motion planning: \displaystyle d\left(\bm{x}_{k},\bm{x}_{k}^{\mathrm{OV},i}\right)\geq d_{\min},\ \ i=1,2,\ldots,N_{O}, (2) where d(\cdot,\cdot) is distance between the EV and OV i with consideration of their geometry, and d_{\min} is the minimum safe distance. The vehicle should also stay within the lane boundaries. Its distance to the closes point B on the boundaries, d_{B}(\bm{x}_{k}) , thus must satisfy \displaystyle d_{B}(\bm{x}_{k})\leq L, (3) where L is the lane width. Further, the control input is subject to \displaystyle\bm{u}_{\min}\leq\bm{u}_{t}\leq\bm{u}_{\max}, (4) due to the vehicle’s actuation limits and passenger comfort needs, with \bm{u}_{\min} and \bm{u}_{\max} denoting the lower and upper bounds of actuation. A passenger would also demand the

Read the complete text