Deterministic methods for motion planning guarantee safety amidst uncertainty in obstacle locations by trying to restrict the robot from operating in any possible location that an obstacle could be in. Unfortunately, this can result in overly conservative behavior. Chance-constrained optimization can be applied to improve the performance of motion planning algorithms by allowing for a user-specified amount of bounded constraint violation. However, state-of-the-art methods rely either on moment-based inequalities, which can be overly conservative, or make it difficult to satisfy assumptions about the class of probability distributions used to model uncertainty. To address these challenges, this work proposes a real-time, risk-aware reachability-based motion planning framework called RADIUS. The method first generates a reachable set of parameterized trajectories for the robot offline. At run time, RADIUS computes a closed-form over-approximation of the risk of a collision with an obstacle. This is done without restricting the probability distribution used to model uncertainty to a simple class (e.g., Gaussian). Then, RADIUS performs real-time optimization to construct a trajectory that can be followed by the robot in a manner that is certified to have a risk of collision that is less than or equal to a user-specified threshold. The proposed algorithm is compared to several state-of-the-art chance-constrained and deterministic methods in simulation, and is shown to consistently outperform them in a variety of driving scenarios. A demonstration of the proposed framework on hardware is also provided.
翻译:摘要:确定性运动规划方法通过限制机器人避开障碍物所有可能占据的位置,来保证在障碍物位置不确定性下的安全性。然而,这可能导致过于保守的行为。通过允许用户指定一定限度的约束违反,可采用机会约束优化来提升运动规划算法的性能。然而,现有方法要么依赖基于矩的不等式(此类不等式可能过于保守),要么难以满足用于建模不确定性的概率分布类别的假设。为应对这些挑战,本文提出了一种名为RADIUS的实时风险感知可达性运动规划框架。该方法首先离线生成机器人参数化轨迹的可达集。在运行时,RADIUS计算与障碍物碰撞风险的封闭形式过近似,且无需将建模不确定性的概率分布限制为简单类别(如高斯分布)。随后,RADIUS执行实时优化以构建一条机器人可遵循的轨迹,并保证其碰撞风险不超过用户指定阈值。通过仿真将所提算法与多种先进的机会约束及确定性方法进行对比,结果表明该算法在多种驾驶场景中始终表现更优。此外,本文还提供了该框架的硬件演示。