[論文レビュー] Optimal cooperative motion planning for vehicles at intersections

Jean Grégoire, Silvère Bonnabel+1 more|arXiv (Cornell University)|Oct 29, 2013

Robotic Path Planning Algorithms参考文献 17被引用数 36

ひとこと要約

本稿は、協調空間と優先順位ベースのスケジューリングを用いて、交差点における最適な協調的運動計画を数学的に厳密に定式化するフレームワークを提案する。問題を協調空間における連続最適化と、優先順位グラフを用いた離散的スケジューリングに分解することで、衝突防止、デッドロック防止、時間最適な軌道を保証する構成可能で局所最適なアルゴリズムを提示する。これは自律走行車両やロボットに適用可能である。

ABSTRACT

We consider the problem of cooperative intersection management. It arises in automated transportation systems for people or goods but also in multi-robots environment. Therefore many solutions have been proposed to avoid collisions. The main problem is to determine collision-free but also deadlock-free and optimal algorithms. Even with a simple definition of optimality, finding a global optimum is a problem of high complexity, especially for open systems involving a large and varying number of vehicles. This paper advocates the use of a mathematical framework based on a decomposition of the problem into a continuous optimization part and a scheduling problem. The paper emphasizes connections between the usual notion of vehicle priority and an abstract formulation of the scheduling problem in the coordination space. A constructive locally optimal algorithm is proposed. More generally, this work opens up for new computationally efficient cooperative motion planning algorithms.

研究の動機と目的

• 交差点における複数の自律走行車両の協調を図ることで、安全性、効率性、最適性を確保する挑戦に応えること。
• 変動する車両数を伴う動的かつオープンなシステムにおいて、計算効率が高く、証明可能に衝突のない運動計画アルゴリズムを開発すること。
• 車両の優先順位という直感的な概念を、連続的な協調空間最適化に関連付ける離散的スケジューリング問題として形式化すること。
• 与えられた優先順位制約の下で、局所最適な軌道を達成する構成可能アルゴリズムを提供すること。
• 離散的スケジューリング（優先順位グラフ）と抽象的協調空間における連続的運動計画問題との間の理論的関連を確立すること。

提案手法

• 車両の運動を固定パスと曲線座標でモデル化し、システムの状態を有界な協調空間 χ = [0,1]^n にマッピングする。
• 衝突および障害物制約を表すために、禁忌領域（H_{i≻j}, χ̄_obs^ij）とゲート（H_{j≻i}）を定義する。
• 車両間の相対順序制約を符号化するための優先順位グラフ G を導入し、実行可能でデッドロックのないスケジューリングを保証する。
• 「左グリーディ」戦略を採用：車両は、禁忌領域または優先順位境界に制約を受けるまで最大速度で移動し、その後直交投影を用いて境界に従う。
• リアルタイムに優先順位グラフを動的に構築するヒューリスティックアルゴリズムを適用し、車両が臨界境界に到達した際に優先順位を更新する。
• 速度調整を直交投影を用いて行う再帰的軌道生成を採用し、禁忌領域を回避しながら、現在の優先順位グラフに対して最適性を維持する。

実験結果

リサーチクエスチョン

• RQ1 交差点における協調的運動計画を、協調空間における連続的最適化問題としてどのように定式化できるか？
• RQ2 高次元の協調空間において、車両の優先順位は、衝突防止およびデッドロック防止のための軌道を保証するために果たす役割は何か？
• RQ3 離散的スケジューリング問題（優先順位グラフ）を、協調空間における連続的運動計画問題と正式にどのように結びつけることができるか？
• RQ4 与えられた優先順位構成に対して、時間最適性を保証する構成可能で局所最適なアルゴリズムを設計できるか？
• RQ5 計算コストを低く抑えつつ、グローバル最適性に近い近似を得るために、効率的なヒューリスティック戦略は何か？

主な発見

• 提案されたフレームワークは、交差点における複雑な運動計画問題を、有界な幾何構造を持つ明確な構造の協調空間にうまくマッピングできた。
• 優先順位グラフは、実行可能な軌道を分類する強力な抽象化を提供し、相対順序制約を符号化することで、デッドロックのない実行を保証する。
• アルゴリズムは「バグ」に類似たパスに従うことで、局所最適な軌道を達成する：禁忌領域に到達するまで最大速度で移動し、その後直交投影を用いて境界に従う。
• この手法は、生成された軌道が与えられた優先順位グラフに対して最適であり、証明可能な衝突回避とデッドロックのない動作を保証する。
• グローバル最適化問題を、実行可能な優先順位グラフの組み合わせ探索に還元することで、車両数が少ない場合にはグローバル最適性への体系的アプローチが可能になる。
• ヒューリスティックアルゴリズムが提案され、リアルタイムに優先順位グラフを動的に構築し、低コストのアルゴリズム的複雑性を維持しながら、局所最適性と安全性を保証する。