基于双向拟合滤波的无人艇水面目标保距跟踪算法研究

Research on the distance-maintenance tracking algorithm of surface targets for USV based on bidirectional fitting filtering

  • 摘要:
    目的 针对无人艇在对水面移动船舶进行保距跟踪过程中,由于目标摆脱运动度大且环境中定位精度不足,导致跟踪过程中出现振动与滞后问题,开展无人艇跟踪策略的研究。
    方法 首先采用基于多项式和粒子群的双向拟合算法对雷达采样数据进行误差消除;然后基于无人艇与动态目标船的运动态势,以无人艇保距稳定跟踪为导向,规划无人艇航速航向。
    结果 实艇试验结果表明,经双向拟合算法滤波后的数据更平滑,符合船舶运动规律;无人艇基于规划的航速航向可稳定跟踪目标船。
    结论 该方法能有效满足无人艇稳定跟踪需求,对单目标跟踪具有良好的效果。

     

    Abstract:
    Objective Maintaining consistent tracking of surface ships using unmanned surface vehicles (USVs) is highly challenging due to the target's high maneuverability and complex motion trajectories. Additionally, environmental interferences in marine settings further complicate the task by reducing positioning accuracy. These issues often result in tracking vibrations and delays, severely impacting stability and precision. To address these challenges, this study proposes innovative solutions to enhance the performance of USVs in maintaining effective target tracking.
    Methods This study introduces an advanced bidirectional fitting algorithm integrating polynomial fitting and particle swarm optimization (PSO) to address radar sampling errors. By systematically analyzing the correlation between target motion amplitude and radar observation errors, the sampling period is optimized to accurately capture the target's motion trends. Additionally, the appropriate number of sampling points is carefully determined. Polynomial fitting is initially applied to minimize longitudinal errors, followed by secondary horizontal error reduction using PSO. A penalty function is incorporated to enforce strict constraints on the fitting range, ensuring that corrected coordinates align with the actual motion capabilities of the target ship. Furthermore, real-time motion data from the USV and the target ship, including target speed, separation distance, and USV performance parameters, are used to develop a robust speed strategy. Geometric methods combined with USV turning dynamics are employed to formulate a precise course strategy, enabling optimal speed and trajectory planning.
    Results Rigorous validation through real-vessel experiments demonstrates that the radar data processed with the bidirectional fitting algorithm achieves significantly enhanced smoothness, closely aligning with the ship's actual motion patterns. Additionally, the USV consistently and accurately tracks the target ship by following the optimized speed and course strategies. Vibrations and delays are effectively mitigated, ensuring stable tracking performance throughout the operation.
    Conclusion The proposed method effectively addresses the challenges of stable target tracking for USVs, demonstrating exceptional performance in single-target scenarios. This work provides critical technical support and practical insights for advancing USV target tracking technology. Its findings hold reference value for further research and offer actionable guidance for broader applications in marine robotics and autonomous systems.

     

/

返回文章
返回