用发光标记+概率切换算法,实现水下无人艇精准相对定位。
AMR-Pose: An Active LED Marker-Based Relative Pose Estimation Framework With Probabilistic Switching PnP for Cooperative AUVs

- 用红心蓝环发光标记,增强水下视觉特征辨识度。
- 在部分标记可见时仍保持姿态估计稳定,误差小于5%。
- 适合水下多机器人协同任务,如勘探与采样。
可靠的自主水下航行器(AUV)间相对位姿估计对协同海洋探测、采样和多机器人协作至关重要。然而,受浊度、光照变化、反射及特征间歇性遮挡等严重光学退化影响,实现鲁棒的基于视觉的相对定位仍具挑战。本文提出AMR-Pose,一种面向协作AUV的主动式LED标记相对位姿估计框架。设计了一种包含一个红色中心LED和三个蓝色外围LED的紧凑标记模块,集成于领航AUV上,在复杂水下环境中提供显著视觉特征。基于检测到的标记观测,提出概率切换透视n点估计算法(PSwPnP),结合SE(3)上的李群姿态传播、概率标记关联与可视性自适应测量融合,实现六自由度的鲁棒相对位姿估计。该框架根据标记可见性动态调整估计过程,确保部分观测与可视性切换期间的几何一致性与时序稳定性。大量水池实验结合运动捕捉真值验证,AMR-Pose在恶劣水下条件下实现了高精度、平滑且鲁棒的相对位姿估计。闭环领航-跟从实验进一步证明其在协同水下机器人系统中实现实时相对位姿反馈的可行性。
原文摘要 · Abstract (English)
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.
Thank you to arXiv for use of its open access interoperability. PaperDance 不是 arXiv 官方产品;中文卡片由大模型生成,请以原文为准。