水中ロボティクス/姿勢推定2026/8/13arXiv:2608.12866v1

AMR-Pose: 協調AUVのための能動LEDマーカーと確率的切替PnPを用いた相対姿勢推定フレームワーク

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

シェア:X Threads Facebook LINE はてブ Bluesky

水中環境での光学的劣化に頑健な、能動LEDマーカーと確率的切替PnPを用いたAUV間の相対姿勢推定フレームワークを提案した。

詳しい要約

1. どんなもの？

AMR-Poseは、協調動作するAUV（自律型水中ロボット）間の相対位置姿勢推定のためのフレームワークである。アクティブLEDマーカー（中央に赤1個、周囲に青3個）をリーダーAUVに搭載し、その観測に基づいて確率的切り替えPnP（PSwPnP）により6自由度の相対ポーズを推定する。水中の濁りや照明変動、反射、断続的なオクルージョンなどの厳しい光学条件下でも頑健な推定を目指す。

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

従来の視覚ベースの水中相対位置推定は、光学劣化や特徴のオクルージョンに弱く、特にマーカーの一部が隠れた場合に推定が不安定になる問題があった。AMR-Poseは、アクティブLEDマーカーにより視覚的特徴を強調し、さらに確率的マーカー対応と可視性適応型の測定融合を導入することで、部分観測や可視性の遷移中でも幾何的一貫性と時間的安定性を維持する点が新しい。

3. 技術・手法の肝は？

手法の核は、検出されたマーカー観測に基づく確率的切り替えPnP推定器（PSwPnP）である。これは、SE(3)上のLie群によるポーズ伝播、確率的マーカー対応、可視性適応型の測定融合を組み合わせる。マーカーの可視状態に応じて推定プロセスを動的に適応させ、部分観測や可視性の切り替え時にも幾何的一貫性と時間的安定性を保つ。

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

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

5. 議論はある？

要旨からは、提案手法の限界や他の手法との比較に関する議論は明示されていない。ただし、実験は水槽環境に限定されており、実海域での性能や、より複雑なマーカー配置、異なる水中条件での汎用性については要旨からは不明である。

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

要旨で参照されている関連研究は明示されていないが、同分野の定番として、視覚ベースのAUV相対位置推定に関する研究や、PnP問題の解法、水中視覚のためのマーカー設計に関する論文が考えられる。具体的には、"Vision-based relative localization for AUVs"や"Robust PnP algorithms"などの一般名で検索される研究が該当する。

※ 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概要ページ

← 論文一覧