核心概念
従来のサンプリングベースのモーションプランナーに、新しいエッジコストメトリックと曲線計画空間を導入することで、長距離経路追従中の障害物回避をサポートする、横方向重み付け動作計画手法を提案する。
要約
概要
本論文は、事前に教示された経路を可能な限り厳密に追従しながら、経路上に新たに出現した障害物を回避するための、横方向重み付け動作計画手法を提案する。
研究の背景
- 不整地環境におけるロボットナビゲーションは、輸送、鉱業、林業など、多くのモバイルロボットアプリケーションにとって困難だが重要な課題である。
- 特に、GPSに依存せずに、短期的および長期的なシーンの変化が存在する場合のロバストなローカリゼーションは、特に困難になる。
- また、オフロードの地形評価問題は、潜在的な障害物の種類が増えるにつれて一般化が難しくなり、衝突を防ぐためには、それらすべてを慎重に識別、計画、制御する必要がある。
Visual Teach & Repeat (VT&R)
- VT&Rは、モバイルロボットが人間のオペレーターによって事前に教示された経路のネットワーク上で動作すれば十分である場合が多いことを示唆することで、これらの問題に取り組んでいる。
- 学習フェーズ(教示パス)では、ロボットはステレオカメラなどの豊富なセンサーを使用して環境の視覚マップを作成しながら、ルートに沿って手動で操縦される。
- 自律走行フェーズ(リピートパス)では、ライブステレオ画像を使用して、照明や季節の変化に対する高い精度と回復力でマップにローカライズする。
本研究の目的
- LiDARベースのVT&Rアーキテクチャの出現により、経路から数メートル離れた場所でもローカリゼーションのロバスト性が向上したため、局所的な障害物回避がより実現可能になった。
- 本研究では、教示パスから一時的に逸脱して新しい障害物を回避し、VT&Rの実用性を高める可能性を探る。
- 特に、困難な環境における障害物認識のための変化検出の信頼性と、可能な限り人間の地形評価の事前情報を活用するために、教示パスからのずれを最小限に抑える経路計画の重要性を強調する。
提案手法
- 本論文の主な貢献は、適用された計画領域にあり、新しいエッジコストメトリックを提示する。このメトリックは、曲線計画空間と組み合わせることで、一般的なサンプルベースの最適モーションプランナーの機能を拡張し、教示パスに沿って局所的な障害物を自然に回避するパスを生成する。
- 特に、障害物のない環境では、プランナーはコーナーをカットすることなく、元の教示パス上にソリューションが残るようにする。
- エッジコストメトリックの重要な特徴は、ウェイポイントに依存することなく、経路長の最小化と横方向の経路ずれの最小化の間の微妙なバランスをとる経路ソリューションを促進する能力である。
- さらに、新しいメトリックは、許容可能なサンプリングヒューリスティックを利用することにより、基礎となる計画アルゴリズムの基本的な特性を維持することを示す。
評価
- 提案する経路プランナーの有効性を示すために、さまざまな現実的な経路追従シナリオで広範なシミュレーションを実施した。
- ランダムに生成された87%の試行で、プランナーは目標への経路を正常に識別し、元の参照パスからの最大横方向ずれを2.5メートルに維持した。
- 経路障害のすべてのインスタンスで、プランナーは、環境内の障害物のランダムな配置により、経路ずれの制約を満たすソリューションが見つからなかったことを正確に報告した。
- さらに、さまざまな非構造化環境で5キロメートルを超える長期自律航行実験を実施し、システムの堅牢な障害物回避能力と、現実の世界への展開の可能性を示した。
- ホモトピーガイドMPCモーションプランナーは、複雑さを増す障害物回避シナリオを通じて、大型のARGO Atlas J8ロボットを正常にナビゲートし、オペレーターの介入なしに100%の障害物回避率を達成しながら、直接追跡MPCアプローチと比較して横方向の経路ずれを最小限に抑えた。
結論
- 本論文では、局所的な障害物回避のための横方向重み付け動作計画手法を提案した。
- 提案手法は、従来のサンプリングベースのモーションプランナーに、新しいエッジコストメトリックと曲線計画空間を導入することで、長距離経路追従中の障害物回避をサポートする。
- シミュレーションと実証実験により、提案手法の有効性が確認された。
統計
87%の試行で、プランナーは目標への経路を正常に識別し、元の参照パスからの最大横方向ずれを2.5メートルに維持した。
5キロメートルを超える長期自律航行実験を実施し、システムの堅牢な障害物回避能力と、現実の世界への展開の可能性を示した。
ホモトピーガイドMPCモーションプランナーは、複雑さを増す障害物回避シナリオを通じて、大型のARGO Atlas J8ロボットを正常にナビゲートし、オペレーターの介入なしに100%の障害物回避率を達成した。