都市環境における動的最適化を用いたリアルタイム空間軌道計画
Real-Time Spatial Trajectory Planning for Urban Environments Using Dynamic Optimization
都市環境の自動運転車向けに、経路と速度を分解し空間上で最適制御問題を解くことで、先読み軌道をリアルタイム生成する計画フレームワークを提案した。
著者: Jona Ruof, Max Bastian Mertens, Michael Buchholz, Klaus Dietmayer
分類: cs.RO, cs.SY, eess.SY
原文アブストラクト
Planning trajectories for automated vehicles in urban environments requires methods with high generality, long planning horizons, and fast update rates. Using a path-velocity decomposition, we contribute a novel planning framework, which generates foresighted trajectories and can handle a wide variety of state and control constraints effectively. In contrast to related work, the proposed optimal control problems are formulated over space rather than time. This spatial formulation decouples environmental constraints from the optimization variables, which allows the application of simple, yet efficient shooting methods. To this end, we present a tailored solution strategy based on ILQR, in the Augmented Lagrangian framework, to rapidly minimize the trajectory objective costs, even under infeasible initial solutions. Evaluations in simulation and on a full-sized automated vehicle in real-world urban traffic show the real-time capability and versatility of the proposed approach.
