[論文レビュー] 3D Maps Registration and Path Planning for Autonomous Robot Navigation

Konstantinos Charalampous, Ioannis Kostavelis+3 more|arXiv (Cornell University)|Dec 10, 2013

Robotics and Sensor-Based Localization参考文献 9被引用数 3

ひとこと要約

本論文は、1台のレーザースキャナを用いて、危険な環境における自律的ロボットナビゲーションのための統合的3次元マッピングおよび経路計画システムを提示する。FPFHに基づく粗い登録と点対平面ICPの精密化を組み合わせて正確な3次元マップを構築し、その後、上から見た2次元グリッドマップに投影する。D* Liteアルゴリズムは、ロボットの物理的寸法（40×41 cm）を明示的に考慮し、29 cmの安全バッファとガウスコスト関数を用いることで、1 cm解像度、1ステップあたり平均3秒未塔の計算時間で、より安全で身体的適合性を考慮した経路を計画する。

ABSTRACT

Mobile robots dedicated in security tasks should be capable of clearly perceiving their environment to competently navigate within cluttered areas, so as to accomplish their assigned mission. The paper in hand describes such an autonomous agent designed to deploy competently in hazardous environments equipped with a laser scanner sensor. During the robot's motion, consecutive scans are obtained to produce dense 3D maps of the area. A 3D point cloud registration technique is exploited to merge the successively created maps during the robot's motion followed by an ICP refinement step. The reconstructed 3D area is then top-down projected with great resolution, to be fed in a path planning algorithm suitable to trace obstacle-free trajectories in the explored area. The main characteristic of the path planner is that the robot's embodiment is considered for producing detailed and safe trajectories of $1$ $cm$ resolution. The proposed method has been evaluated with our mobile robot in several outdoor scenarios revealing remarkable performance.

研究の動機と目的

• クラッターで危険な環境（例：災害後地域）において、自律移動ロボットが安全にナビゲートできるようにすること。
• リアルタイムで、連続する2次元レーザースキャンから正確で高密度な3次元マップを生成する課題に対処すること。
• ロボットの物理的寸法を考慮した経路計画アルゴリズムを統合し、障害物との衝突を回避すること。
• ロボットのフットプリントに基づいて障害物に近いセルにコストペナルティを割り当てることで、経路の安全性と現実性を向上させること。
• 都市探査救助ミッションへの展開に適した、センサ効率の高い完全なナビゲーションフレームワークを開発すること。

提案手法

• 車輪式ロボット（ERA-Mobi）に、PTUに取り付けられたSICK LMS500 PRO 2Dレーザースキャナと、Xsens 3DoF姿勢トラッカーを搭載し、移動および姿勢のセンシングを実施する。
• 連続する3次元点群の初期変換を推定するために、高速でオンラインな粗い登録としてFPFH特徴を適用する。
• 共有された幾何的表面に属する点にのみ焦点を当てることで、速度と正確性を向上させる点対平面ICPアルゴリズムを用いて登録を精密化する。
• 最終的な登録済み3次元マップを、1 cm解像度の上から見た2次元グリッドマップに投影する。
• ロボットの中心からの最大距離に基づき、非通過可能な障害物から29 cm以内のセルに、σx = σy = 1のガウスコスト関数を用いて増加するペナルティ値を割り当てる。
• 強化された2次元マップ上でD* Liteアルゴリズムを実装し、経路長と安全性のバランスを取った最適で衝突のない経路を計算する。

実験結果

リサーチクエスチョン

• RQ1 連続する2次元レーザースキャンから得られる3次元点群を、未知の環境の整合的な3次元マップを構築するためにリアルタイムで正確に登録する方法は何か？
• RQ2 障害物にあまり近づかないようにするため、ロボットの身体的適合性を経路計画に組み込む有効な方法は何か？
• RQ3 3次元再構築から導出された高解像度2次元マップは、1m未塔の精度でリアルタイムかつ安全な経路計画を可能にするか？
• RQ4 ICPにおける幾何的表面制約の統合は、登録の効率性と正確性をどのように向上させるか？
• RQ5 身体的適合性を考慮したコスト割り当ては、計算時間の大幅な増加を伴わずに、どれほど経路の安全性を向上させるか？

主な発見

• FPFHに基づく粗い登録は、1組のスキャンあたり平均38.4 ± 6.4秒の実行時間で、高速な初期アライメントを可能にした。
• ICPの精密化ステップは、平均して2.9 ± 1.7秒で完了し、共有された幾何的表面に限定することで、計算時間を顕著に短縮した。
• D* Lite経路計画アルゴリズムは、1ステップあたり2.4 ± 0.3秒で安全で詳細な経路を計算し、1 cm解像度のマップにより正確なナビゲーションを可能にした。
• 29 cmの安全半径とガウスコスト関数を用いた身体的適合性を考慮した経路計画により、障害物に近すぎる経路を効果的に回避したことが、屋外シナリオでも確認された。
• 35 mの距離差があるより大きなシナリオでも、登録および経路計画の性能は一貫しており、ICPおよびD* Liteの処理時間は最初のケースと1秒以内の差にとどまり、スケーラビリティを示した。
• 本システムは、正確な床面除去と障害物表現を伴う一貫性があり高密度な3次元マップを生成し、複雑な現実世界の環境における信頼性の高いナビゲーションを可能にした。