最適化ベースの軌道計画・制御における衝突回避制約の効率的定式化
Efficient Formulation of Collision Avoidance Constraints in Optimization Based Trajectory Planning and Control
移動自律システムの最適化ベース軌道計画のため、楕円体・CSG・符号付き距離など衝突回避制約の代表的手法を整理し、系の形状を考慮でき制約数が少ない新CSG変種を提案、船舶の軌道計画で性能比較した。
著者: Max Lutz, Thomas Meurer
分類: math.OC, cs.RO
原文アブストラクト
To be applicable to real world scenarios trajectory planning schemes for mobile autonomous systems must be able to efficiently deal with obstacles in the area of operation. In the context of optimization based trajectory planning and control a number of different approaches to formulate collision avoidance constraints can be found in the literature. Here the contribution of the present work is twofold. First, the most popular methods to represent obstacles are summarized, namely the simple ellipsoidal representation, the constructive solid geometry (CSG) method as well as a direct and an indirect implementation of a signed distance based approach. The formulations are characterized with respect to the impact on the complexity of the optimization problem, as well as the ability to meet different problem requirements. Second, this work presents a novel variant of the CSG method to describe collision avoidance constraints. It is highly efficient due to a very low number of nonlinear inequality constraints required for a given number of obstacles and sample points and in contrast to the original CSG formulation allows to consider the controlled system's shape. The good performance of the proposed formulation is demonstrated by a comparison to the previously mentioned alternatives. To this end optimal trajectory planning for marine surface vessels formulated as a nonlinear programming problem is used as a benchmark example where the scenario is designed based on the maritime test field in Kiel, Germany.
