不確実な非凸環境における凸リスク有界連続時間軌道計画
Convex Risk Bounded Continuous-Time Trajectory Planning in Uncertain Nonconvex Environments
確率的な位置・大きさ・形状を持つ障害物がある非凸環境で、衝突リスクを有界に保つ連続時間軌道を、リスクコンターとSOS最適化により時間離散化なしで求める手法を提案した。
著者: Ashkan Jasour, Weiqiao Han, Brian Williams
分類: cs.RO, cs.SY, eess.SY, math.OC
原文アブストラクト
In this paper, we address the trajectory planning problem in uncertain nonconvex static and dynamic environments that contain obstacles with probabilistic location, size, and geometry. To address this problem, we provide a risk bounded trajectory planning method that looks for continuous-time trajectories with guaranteed bounded risk over the planning time horizon. Risk is defined as the probability of collision with uncertain obstacles. Existing approaches to address risk bounded trajectory planning problems either are limited to Gaussian uncertainties and convex obstacles or rely on sampling-based methods that need uncertainty samples and time discretization. To address the risk bounded trajectory planning problem, we leverage the notion of risk contours to transform the risk bounded planning problem into a deterministic optimization problem. Risk contours are the set of all points in the uncertain environment with guaranteed bounded risk. The obtained deterministic optimization is, in general, nonlinear and nonconvex time-varying optimization. We provide convex methods based on sum-of-squares optimization to efficiently solve the obtained nonconvex time-varying optimization problem and obtain the continuous-time risk bounded trajectories without time discretization. The provided approach deals with arbitrary probabilistic uncertainties, nonconvex and nonlinear, static and dynamic obstacles, and is suitable for online trajectory planning problems.
