[論文レビュー] Fusing Odometry, UWB Ranging, and Spatial Detections for Relative Multi-Robot Localization

Xianjia Yu, Catalano, Iacopo+4 more|arXiv (Cornell University)|Apr 13, 2023

Indoor and Outdoor Localization Technologies被引用数 5

ひとこと要約

本論文は、相互間のUWB距離測定、オドメトリ、ステレオカメラからの協調的空間検出を統合する、パーティクルフィルタベースの相対的マルチロボット局所化システムを提案する。実証により、1つのUWB距離をオドメトリとLSTMベースの誤差補正と組み合わせることで、多点計測法を上回る精度で相対状態推定が可能であり、低消費電力プラットフォームでもリアルタイム性能を達成でき、位置誤差は15 cm未塔を満たすことが示された。

ABSTRACT

This letter presents a cooperative relative multi-robot localization design and experimental study. We propose a flexible Monte Carlo approach leveraging a particle filter to estimate relative states. The estimation can be based on inter-robot Ultra-Wideband (UWB) ranging and onboard odometry alone or dynamically integrated with cooperative spatial object detections from stereo cameras mounted on each robot. The main contributions of this work are as follows. First, we show that a single UWB range is enough to estimate the accurate relative states of two robots when fusing odometry measurements. Second, our experiments also demonstrate that our approach surpasses traditional methods, namely, multilateration, in terms of accuracy. Third, to further increase accuracy, we allow for the integration of cooperative spatial detections. Finally, we show how ROS 2 and Zenoh can be integrated to build a scalable wireless communication solution for multi-robot systems. The experimental validation includes real-time deployment and autonomous navigation based on the relative positioning method. It is worth mentioning that we also address the challenges for UWB-ranging error mitigation for mobile transceivers. The code is available at https://github.com/TIERS/uwb-cooperative-mrs-localization.

研究の動機と目的

• センサコストと複雑さを最小限に抑えた、インfrastrucureフリーで柔軟なマルチロボットシステムの相対局所化手法の開発。
• 従来の多点計測法に依存せずに、1ロボットペアあたり1つのUWB距離のみを用いても、正確な相対状態推定を実現する。
• 距離とヨー方位角の両方のデータを用いてトレーニングされたLSTMベースのキャリブレーションモデルにより、移動型トランシieverにおけるUWB距離測定誤差を低減する。
• 環境特徴が検出可能な場合に限り、ステレオカメラからの協調的空間検出を動的に統合し、局所化精度を向上させる。
• ROS 2とZenohを用いて、スケーラブルな通信を実現し、組み込みプラットフォーム上でリアルタイムにシステムを実装・検証する。

提案手法

• 相対的ロボット状態の推定には、逐次モンテカルロ（パーティクルフィルタ）フレームワークを用い、オドメトリ、UWB距離、協調的空間検出を統合する。
• UWB距離測定データは、個々のロボットペアごとにトレーニングされた長短期記憶（LSTM）ネットワークを用いて事前処理され、距離とロボットのヨー方位角を入力として、個別の距離測定誤差を予測・補正する。
• 全ロボットが同一のヨー方向基準フレームを共有する2次元ヨー基準フレームを採用し、相対的状態の整合性を簡素化する。
• 2台以上のロボットが同一の環境オブジェクトを検出する場合、その3次元ポーズがパーティクルフィルタ内での相対的制約として統合される。
• ROS 2とZenohを用いて、複数ロボット間で低遅延かつスケーラブルな無線通信を実現し、システムを展開する。
• パーティクルフィルタは、UWB距離、オドメトリ、空間検出の残差から計算される尤度に基づき、可能な相対的状態を表す重み付きパーティクルの集合を維持する。

実験結果

リサーチクエスチョン

• RQ1 1つのUWB距離（多点計測法に依存せず）のみを用いても、相対的状態推定を正確に実現できるか？
• RQ2 リアルタイムで移動型トランシieverに適用可能なLSTMベースの誤差補正モデルは、UWB距離測定誤差をどれほど低減できるか？
• RQ3 ステレオカメラからの協調的空間検出を統合することで、相対局所化精度はどの程度向上するか？
• RQ4 従来の多点計測法に依存する手法と比較して、本手法の精度と計算効率はいかがなっているか？
• RQ5 低消費電力の組み込みプラットフォーム上でのシステムのリアルタイム性能とリソース使用率はどのようになっているか？

主な発見

• 1つのUWB距離を用いた提案されたパーティクルフィルタ（PF U）は、多点計測法を上回り、絶対位置誤差（APE）が顕著に低減されている。これは、オドメトリと融合することで1つの距離で十分であることを示している。
• LSTMベースのUWB誤差補正を組み込んだ（PF UL）と、補正なしのUWBデータと比較してAPEが最大40％低減され、中央値APEは0.1094 mまで低下した。
• 協調的空間検出の統合（PF ULV）により、APEはさらに0.10125 mまで低下し、環境特徴が利用可能な場合に精度向上が明確に確認された。
• Intel PC、Jetson Nano、Raspberry Pi 4Bの各プラットフォームで、CPU使用率24％未満、メモリ使用量500 MB未満の低消費電力でリアルタイム性能を達成した。
• 自律走行における絶対軌道誤差（ATE）は約0.0872 mであり、相対局所化を用いた優れた経路追従能力を示している。
• ROS 2とZenohの統合により、スケーラブルで低遅延な通信が実現され、異種コンピューティングプラットフォーム間でのリアルタイム展開を支援した。