基于双层非共面灯阵与优化位姿估计的AUV自主回收视觉导引方法

Visual guidance for AUV recovery using dual-layer light array and pose optimization

  • 摘要: 【目的】针对自主水下航行器(AUV)在接近回收笼过程中因姿态偏移导致视觉信标可见性退化、位姿估计精度下降的问题,提出一种融合优化灯阵布局与位姿估计的双目视觉导引新方法。【方法】首先,设计一种“3+3”双层非共面灯阵布局,通过在不同深度平面布设光源,增强空间几何约束的多样性;其次,改进双目视觉位姿估计算法,在传统三角测量结合SVD求解初值的基础上,引入基于双目重投影误差的非线性优化步骤。【结果】仿真与陆上实验表明,在距离0.5~10 m、偏航角±60°范围内,方法的平移误差控制在相对距离的4%以内,旋转误差小于3.2°;即使在仅3个光源可见时,仍能保持稳定解算,位姿可解算概率显著优于单层布局。【结论】所提方法通过空间纵深布局与优化算法相结合,显著提升了AUV自主回收末端导引在复杂视角下的鲁棒性与精度。

     

    Abstract: Objectives To address the problem of visual beacon visibility degradation and pose estimation accuracy decline caused by attitude deviation during autonomous underwater vehicle (AUV) approach to recovery cage, a novel binocular visual guidance method integrating optimized light array layout and pose estimation is proposed. Methods First, a "3+3" dual-layer non-coplanar light array layout is designed, which enhances the diversity of spatial geometric constraints by deploying light sources on different depth planes. Second, the binocular visual pose estimation algorithm is improved by introducing a nonlinear optimization step based on binocular reprojection error on the basis of traditional triangulation combined with SVD initial value solution. Results Simulations and ground experiments demonstrate that within a range of 0.5~10 m and yaw angles of ±60°, the translation error of the method is controlled within 4% of the relative distance, and the rotation error is less than 3.2°. Even when only 3 light sources are visible, stable solution can be maintained, and the pose solvability probability is significantly superior to single-layer layouts. Conclusions The proposed method significantly improves the robustness and accuracy of AUV autonomous recovery terminal guidance under complex viewing angles through the combination of spatial depth layout and optimization algorithm.

     

/

返回文章
返回