Multi-agent Path Finding in Continuous Environment

Kristýna Janovská, Pavel Surynek
採択先: ICTAI ・ 2024-09-16 ・ source: arxiv
補充候補採択先 ICTAI公開日 2024-09-16キーワード一致 2被引用 0関連度 5本文(arXiv)読む価値 4/5
連続的な時空間におけるMAPFという難題に対し、CBSとRRT*を組み合わせた提案手法は新規性が高く、既存のSMT-CBSに対する優位性も示されており、実用的な価値が高い。
本文取得済み: 本文(arXiv)を根拠に要約しています。
Multi-Agent Path FindingMAPF
一言で: 時間と空間が共に連続的な環境において、エージェントが滑らかな曲線経路を辿りながら衝突を回避する問題に対し、高レベルの探索にConflict-Based Search、低レベルの経路計画にRRT*を組み合わせたCE-CBSを提案した。

どんなもの?

倉庫物流や自動運転のような実社会のシナリオを想定した、時間と空間が共に連続的な環境におけるマルチエージェント経路計画(SC-MAPF)を対象とする。エージェントは固定半径を持つ円形の剛体であり、各エージェントは開始位置から目標位置まで、運動学的制約を満たす滑らかな曲線に沿って移動しなければならない。従来の離散的なグラフに基づく手法では、連続的な移動や任意の時刻における衝突判定、および滑らかな経路の生成を同時に扱うことが困難であった。

先行研究と比べてどこがすごい?

従来のContinuous Conflict-Based Search(CCBS)を拡張し、低レベルの経路計画にRRT*を導入することで、連続的な空間・時間における解の完全性と経路の滑らかさを両立させた点が新規である。これにより、離散的な移動制約に縛られず、障害物のある環境下での時間的衝突を含む複雑なケースにおいても、既存のSMT-CBSなどの手法より短い非衝突経路を見つけることが可能となった。

技術や手法のキモはどこ?

高レベルの探索ではConflict-Based Searchを用い、全エージェントの経路長の総和を最小化する衝突のない解を探索する。低レベルの探索では、静的な障害物と高レベルから与えられる動的な時間制約(特定の座標における進入禁止時間帯)の両方を回避するように修正されたRRT*を実行する。得られた経路はB-spline曲線を用いて平滑化される。平滑化後の経路が制約を満たさない場合は、平滑化パラメータの調整や、RRT*の最大サンプリングノード数を変更した再計画を繰り返すことで、有効な解を求める。

どうやって有効だと検証した?

RRT*の最大サンプリングノード数、経路セグメント間の最小角度、エージェントの半径が性能に与える影響を検証した。比較対象として、離散的なグリッド環境に基づくCBSおよびSMT-CBSを用い、経路長の総和を評価指標とした。実験の結果、CE-CBSはグリッド移動の制約を受けないため、標準的なCBSよりも総コストが低かった。また、SMT-CBSと比較しても、障害物のある環境下での時間的衝突を含むすべてのケースにおいて、より短い非衝突経路を生成できることが示された。

議論はある?(限界・課題)

RRT*の最大ノード数を増やすと経路の品質は向上するが、衝突の発生頻度が高まり、高レベルの探索における反復回数と計算時間が増大するというトレードオフが存在する。計算時間は衝突回避のための再計画回数に依存するが、衝突が発生することで探索空間が枝刈りされ、RRT*の探索効率に寄与する側面もある。今後の課題として、より広範で複雑な運動学的制約条件をモデルに組み込むことが挙げられている。

セクション別の詳細要約

Multi-agent Path Finding in Continuous Environment

本研究では、エージェントが滑らかな曲線に沿って移動する連続環境におけるマルチエージェント経路探索(CE-MAPF)を扱う。エージェント間の衝突は、空間領域における回避によって解決される。提案手法であるCE-CBSは、高レベルの探索フレームワークとしてConflict-Based Search(CBS)を用い、低レベルの経路計画にはRRT*を組み合わせたアルゴリズムである。多様なCE-MAPFのインスタンスを用いた実験の結果、CE-CBSは連続的な時間を考慮する他の手法と比較して、競争力のある性能を示すことが確認された。

I Introduction

本研究は、倉庫物流や自動運転などの実社会のシナリオを反映させるため、時間と空間の両方が連続的な環境におけるマルチエージェント経路計画(MAPF)を対象としている。エージェントは剛体である円形の物体として定義され、衝突は任意の時刻において2つのエージェントが重なり合うことで発生する。提案手法であるCE-CBSは、既存のContinuous Conflict-Based Searchを拡張したものであり、各エージェントの経路生成にはRRT*アルゴリズムを用い、その出力をB-spline曲線によって平滑化することで、連続的な移動を実現する。この手法は、制約付きの単一エージェント経路計画、平滑化メカニズム、および連続環境におけるマルチエージェント経路計画アルゴリズムの複数の要素で構成される。実験では、提案モデルの性能に影響を与える複数の重要なパラメータを導入し、その影響を調査する。

II Related work

連続的な空間と時間におけるマルチエージェント経路計画(MAPF)に関する既存研究として、まずSMT-CBS Rは、CBSアルゴリズムと充足可能性モジュロ理論(SMT)を組み合わせ、幾何学的なエージェントを用いたメイクスパン最適解を求める手法である。この手法は制約を遅延して導入することでモデルの完全な指定前に解を見つけることが可能であり、衝突時に分岐する代わりに論理モデルを更新することで、CCBSと同等の性能を実現している。次に、MA-RRT*はユークリッド空間の離散的な運動グラフ上で動作し、全エージェントの結合アクションを貪欲法で生成して衝突を確認する手法であり、大規模で疎な環境では結合状態空間におけるA*よりも効率的だが、解の質はわずかに低下する。ORRT-A*は、RRTとA*のヒューリスティックを最適化した後に3次スプラインを用いて経路を平滑化する手法であり、目標バイアス型RRTやRRT-A*と比較して経路の質を向上させている。また、MA-RRT*FNは、ツリー内のノード数を一定に制限し、目標到達の可能性が低いノードを削除することで、MA-RRT*と同等の経路品質を維持しつつメモリ使用量を削減している。分散型のアプローチとしては、優先順位に基づきエージェントを順次処理するMulti-RRT*があり、他エージェントの解を既知の時変障害物と見なして個別に軌道を計算することでパレート最適解を目指す。さらに、線形動力学を持つエージェントが複雑な環境や狭い通路を通過するために、キノダイナミックRRT*とスケジューリングシステムを用いて、衝突のない効率的な移動を実現する研究も存在する。

III Continuous-Environment MAPF

本研究では、時間と環境の両方が連続的であるSmooth Continuous MAPF (SC-MAPF) という問題を定義している。この問題において、環境はグラフ構造で表され、各エッジは2つの頂点を結ぶ滑らかな曲線の集合として定義される。エージェントは各エッジから曲線を選択して一連のアクションを構成することで、開始地点から目標地点へと移動する。エージェントの軌跡は、時間から空間の座標への写像として定義され、滑らかな曲線であるとともに、経路のセグメント間の最小角度を指定する最小角度制約などの運動学的制約を満たす必要がある。エージェントの形状は固定半径を持つ円として定義され、衝突とは、ある時刻において2つのエージェントの体が重なり合う状態を指す。解として求められるのは、すべてのエージェントが設定された速度で移動し、運動学的制約を満たしながら、いかなる時刻においてもエージェント同士が重なり合わずに目標地点へ到達する一連のアクションの集合である。

IV Background

本セクションでは、マルチエージェント経路探索(MAPF)における既存手法の背景が述べられている。まず、離散的なグラフ環境と時間ステップを扱うConflict-Based Search (CBS) は、高レベルでの衝突解決と低レベルでの単一エージェント経路計算の2層構造を持ち、全エージェントの経路コストの最大値であるメイクスパンの最小化を目的とする。これに対し、連続時間を扱うContinuous Time Conflict-Based Search (CCBS) は、特定の時刻における頂点の占有ではなく、開始時刻と動作のペアで定義される「時刻付き動作」の衝突を扱う。また、連続的なメトリック空間における経路計画手法として、確率的に完全であるが最適性を保証しないRRTと、A*のコスト関数を導入して最適解への収束を可能にしたRRT*が挙げられる。さらに、RRT*で生成された経路の急激な方向転換を抑制し、車両の運動学的制約などを考慮した滑らかな経路を得るための手法として、B-spline曲線を用いた平滑化が紹介されている。B-spline曲線は、制御点とノットベクトルに基づく基底関数の線形結合として定義される区分的多項式曲線であり、複雑な障害物環境においても制御点の配置に関わらず滑らかに接続される特性を持つ。

V Proposed Model

本研究では、環境の離散化を最小限に抑えることを目的とした、連続時間・連続空間におけるマルチエージェント経路探索アルゴリズムであるContinuous Environment Conflict-Based Search (CE-CBS)を提案する。高レベルの探索では、全エージェントの経路長の総和を最小化する衝突のない解を求め、低レベルの探索では、RRT*アルゴリズムを用いて各エージェントの経路を計画する。衝突は、2つのエージェント、それぞれの到達時刻、および衝突座標の組み合わせによって定義され、経路の交差判定や、経路セグメント間の最短距離がエージェントの半径を下回るか、あるいはエージェントが特定の「安全でない時間間隔」内に衝突地点へ到達するかによって判定される。低レベルのRRT*は、静的な長方形の障害物と、CE-CBSから与えられる特定の時間帯のみ存在する動的な制約の両方を回避し、かつ隣接する経路セグメント間の角度が一定の最小値以上であるという運動学的制約を満たす必要がある。経路の平滑化にはB-spline曲線を用いた補間が行われるが、角度制約を満たさない場合は、共有頂点の削除や移動による修正を試みた後、サンプリングする最大ノード数を減らしてRRT*を再実行することで、制約を満たす経路を探索する。このモデルは、低レベルの確率的完全性と、有効な解が見つかるまで反復を続ける高レベルの性質により、解の完全性を備えている。

VI Experiments

本実験では、提案手法であるCE-CBSの性能を、RRT*の最大サンプリングノード数、エージェントの半径、および既存手法との比較という観点から検証しています。RRT*の最大ノード数を増やすと、経路が最適解に近づくため総コストは減少しますが、一方で衝突が発生しやすくなり、CE-CBSの反復回数(探索ノード数)が増加し、結果のばらつきも大きくなる傾向があります。エージェントの半径を大きくした場合、エージェント同士の衝突を避けるためのより長い迂回が必要になるため、総コストは例外なく増加します。一方で、エージェントの体が大きくなることで、静止障害物との距離を保つために探索空間がより制限されるため、結果のばらつきはわずかに減少します。標準的なCBS(A*を使用)との比較では、グリッド移動の制約を受けないCE-CBSの方が、総コストにおいて低い値を示しました。また、SMT-CBSとの比較においても、CE-CBSは移動制約の緩和により、障害物のある環境下での時間的衝突を含むすべてのケースにおいて、より短い非衝突経路を見つけることができました。

VII Discussion

実験の結果、提案モデルは多様な環境に適応可能であり、特定のシナリオに合わせてパラメータを調整できることが示されました。検討されたパラメータの中では、RRT*における最大ノード数が解の品質に最も大きな影響を与えます。計算時間はCE-CBSの反復回数に依存するため、計画中に衝突が頻発してRRT*の再計画が繰り返されるほど計算時間は増大します。一方で、衝突の発生は探索空間を枝刈りし、RRT*が制約のない領域をより広く探索することを可能にするため、衝突回数と計算時間の関係はある程度バランスが取れることが示されました。エージェントは、狭い通路や複数の衝突が発生しうる空間においても、最短経路を探索しながら衝突を回避してナビゲートできます。また、角度制約を満たしつつ、他のエージェントや静止障害物を避けながら滑らかな曲線を描いて移動することが可能です。

VIII Conclusion

本研究は、連続的な環境においてエージェント間の衝突を回避する経路計画手法を提案している。提案手法であるCE-CBSは、既存のCCBSアルゴリズムとRRT*を基盤とし、経路を滑らかにするメカニズムを組み込んでいる。各エージェントはCE-CBSを通じて通信を行い、衝突のない経路を計画する。個別の経路計画には、CE-CBSによる制約と運動学的な制約の両方を考慮するように修正されたRRT*が用いられる。出力された経路は、Bスプライン曲線を用いて平滑化される。今後の課題として、より広範な運動学的な制約条件をモデルに組み込むことが挙げられている。