提出一种高效确定性碰撞概率估计方法,提升自动驾驶路径规划安全性。
Collision Probability Estimation for Optimization-based Vehicular Motion Planning
- 用多圆近似车辆形状,结合位置与朝向的随机模型估算碰撞概率。
- 针对高斯不确定性,实现快速计算且保证结果保守(上界)。
- 适用于需重复可重现轨迹的随机模型预测控制,适合安全关键场景。
自动驾驶中的运动规划算法常需估算碰撞概率(POC)以应对道路参与者运动状态的不确定性。传统采样方法存在计算效率低和结果随机的问题。相比之下,基于优化的规划需高效且确定性的POC估计,以保障可行性。本文提出一种新方法:通过多圆形状近似车辆,并将预测车辆的位置与航向建模为随机变量(区别于以往忽略航向的做法),确保所估POC为保守上界,满足安全要求。针对位置与航向呈高斯分布的情况,设计了高效计算算法。该算法被集成至路径跟随式随机模型预测控制器(SMPC)中,在测试案例中生成可复现轨迹,同时保持控制可行性,并能处理不同水平的不确定性。
原文摘要 · Abstract (English)
Many motion planning algorithms for automated driving require estimating the probability of collision (POC) to account for uncertainties in the measurement and estimation of the motion of road users. Common POC estimation techniques often utilize sampling-based methods that suffer from computational inefficiency and a non-deterministic estimation, i.e., each estimation result for the same inputs is slightly different. In contrast, optimization-based motion planning algorithms require computationally efficient POC estimation, ideally using deterministic estimation, such that typical optimization algorithms for motion planning retain feasibility. Estimating the POC analytically, however, is challenging because it depends on understanding the collision conditions (e.g., vehicle's shape) and characterizing the uncertainty in motion prediction. In this paper, we propose an approach in which we estimate the POC between two vehicles by over-approximating their shapes by a multi-circular shape approximation. The position and heading of the predicted vehicle are modelled as random variables, contrasting with the literature, where the heading angle is often neglected. We guarantee that the provided POC is an over-approximation, which is essential in providing safety guarantees. For the particular case of Gaussian uncertainty in the position and heading, we present a computationally efficient algorithm for computing the POC estimate. This algorithm is then used in a path-following stochastic model predictive controller (SMPC) for motion planning. With the proposed algorithm, the SMPC generates reproducible trajectories while the controller retains its feasibility in the presented test cases and demonstrates the ability to handle varying levels of uncertainty.
Thank you to arXiv for use of its open access interoperability. PaperDance 不是 arXiv 官方产品;中文卡片由大模型生成,请以原文为准。