水面机器人面向动态对接的目标位姿视觉检测

Visual Detection of Target Pose for Dynamic Docking of Unmanned Surface Vehicle

  • 摘要: 水面机器人(USV)在动态对接过程中需要获取目标的精确位姿,然而目标运动所导致的大观测角度、运动模糊及遮挡等问题容易引起特征退化,使得传统平面标志物难以实现全方位的稳定检测。为此,本文提出一种基于立体标志物的视觉位姿检测方法。首先,设计了一种由多环嵌套结构组成的四面立体标志物,利用圆形投影特征与立体分布特性,实现全向姿态检测;其次,提出一种基于圆环投影与同心度约束的弧段匹配方法,能够在标志物特征退化或部分缺失的情况下实现稳定识别;接着,提出基于成像模型的目标定位方法,通过仿射变换对圆形特征进行矫正,并借助正四棱柱的几何特性优化定位结果;最后,结合目标运动的时序趋势,实现对目标姿态的连续检测。仿真结果表明,在30 m范围内,最大位置误差小于0.8 m、最大航向误差小于5°,验证了方法的准确性。实船实验结果显示:静态实验中位置误差为1.2 m,最大航向误差小于6.2°;动态实验中,对接末期位置误差小于0.16 m, 85%航向误差小于5°,进一步验证了方法的可行性。

     

    Abstract: Unmanned surface vehicle(USV) requires accurate pose estimation of the target during dynamic docking operations. However, large observation angles, motion blur, and occlusion caused by target motion can lead to feature degradation, making traditional planar markers inadequate for reliable omnidirectional detection. To address this problem, this paper proposes a vision-based pose detection method using a stereo marker. Firstly, a four-faced stereo marker composed of a multi-ring nested structure is designed, which enables full-attitude detection by utilizing circular projection features and stereo distribution properties. Secondly, an arc segment matching method based on ring projection and concentricity constraints is introduced, allowing stable recognition even when marker features degrade or are partially missing. Next, a target localization method based on an imaging model is proposed, which corrects circular features through affine transformation and optimizes localization results using the geometric properties of a regular quadrangular prism. Finally, continuous attitude estimation is achieved by incorporating the temporal trend of target motion. Simulation results show that the maximum position error is below 0.8 m and the maximum heading error is less than 5° within a range of 30 m, verifying the accuracy of the method. Real-world ship experiments demonstrate that the position error is below 1.2 m and the maximum heading error is under 6.2° in static tests, and the position error at the final stage is below 0.16 m and 85% of the heading errors are within 5° in dynamic docking tests, further confirming the feasibility and practicality of the proposed method.

     

/

返回文章
返回