2026/8/1arXiv:2608.12866

AMR-Pose: An Active LED Marker-Based Relative Pose Estimation Framework With Probabilistic Switching PnP for Cooperative AUVs

詳しい要約

1. どんなもの？

AMR-Poseは、協調動作するAUV（自律型水中ロボット）間の相対位置姿勢推定のためのフレームワークである。リーダーAUVに搭載されたアクティブLEDマーカー（中央1個の赤色LEDと周囲3個の青色LEDからなるコンパクトなモジュール）を視覚的に検出し、確率的スイッチングPnP推定器（PSwPnP）を用いて6自由度の相対ポーズをロバストに推定する。水中の濁り、照明変動、反射、断続的なオクルージョンなどの厳しい光学劣化条件下でも動作することを目指す。

2. 先行研究と比べてどこがすごい？

従来の水中視覚ベースの相対位置推定は、光学劣化や特徴のオクルージョンに対して脆弱であり、特にマーカーの一部が隠れた場合や視認性が変化する場合に推定が不安定になる問題があった。AMR-Poseは、アクティブLEDマーカーを用いることで視覚的特徴の識別性を高め、さらに確率的スイッチングPnPによりマーカーの可視性に応じて推定プロセスを動的に適応させる点が新しい。これにより、部分的な観測や可視性の遷移中でも幾何学的整合性と時間的安定性を維持できる。

3. 技術・手法の肝は？

手法の核は、Lie群SE(3)上でのポーズ伝播、確率的マーカー対応付け、可視性適応型の測定融合を組み合わせた確率的スイッチングPnP推定器（PSwPnP）である。マーカーの可視性に応じて推定プロセスを動的に切り替え、部分観測や可視性の遷移中でも幾何学的整合性と時間的安定性を保つ。具体的には、マーカーの検出結果から対応点を確率的に推定し、可視性に応じて測定値を融合することで、ロバストな6自由度相対ポーズ推定を実現する。

4. どうやって有効だと検証した？

水槽実験を実施し、モーションキャプチャによるグラウンドトゥルースと比較して、厳しい水中条件下での正確で滑らか、かつロバストな相対ポーズ推定を検証した。さらに、閉ループのリーダー・フォロワー実験により、協調水中ロボティクスにおけるリアルタイムの相対ポーズフィードバックへの実用性を実証した。

5. 議論はある？

要旨からは、提案手法の限界や他の手法との比較に関する議論は明示されていない。ただし、実験は水槽内で行われており、実海域での性能や、より複雑な環境でのスケーラビリティについては不明である。また、アクティブLEDマーカーはエネルギー消費や視認距離に制約がある可能性が考えられるが、要旨では言及されていない。

6. 次に読むべき論文は？

要旨で参照されている関連研究は明示されていないが、同分野の定番として、視覚ベースのAUV相対位置推定に関する研究（例えば、視覚マーカーを用いた相対ナビゲーション）や、PnP問題のロバスト解法に関する論文が挙げられる。具体的には、"Perspective-n-Point"問題の解法や、水中ロボティクスにおける協調ナビゲーションに関する論文が関連する。

※ AIが要旨から生成した要約です。正確性は原文をご確認ください。

著者: Zeyu Sha, Xiaorui Wang, Mingyang Yang, Feitian Zhang

分類: cs.RO

原文アブストラクト

Reliable relative pose estimation between autonomous underwater vehicles (AUVs) is critical for cooperative ocean exploration, sampling, and multi-robot coordination. However, achieving robust vision-based relative localization in underwater environments remains challenging due to severe optical degradation, including turbidity, illumination variations, reflections, and intermittent feature occlusions. This paper presents AMR-Pose, an active LED marker-based relative pose estimation framework for cooperative AUVs. A compact marker module consisting of one red central LED and three blue peripheral LEDs is developed and integrated onto the leader AUV to provide distinctive visual features under complex underwater conditions. Building upon the detected marker observations, a probabilistic switching Perspective-n-Point estimator (PSwPnP) is developed by combining Lie-group pose propagation on $SE(3)$, probabilistic marker association, and visibility-adaptive measurement fusion for robust six-degree-of-freedom relative pose estimation. The proposed framework dynamically adapts the estimation process according to marker visibility, maintaining geometric consistency and temporal stability during partial observations and visibility transitions. Extensive water-tank experiments with motion-capture ground truth validate that AMR-Pose achieves accurate, smooth, and robust relative pose estimation under challenging underwater conditions. Closed-loop leader-follower experiments further demonstrate its feasibility for real-time relative pose feedback in cooperative underwater robotics.

arXivで原文を読む →arXiv概要ページ

← 論文一覧