Error mitigation algorithm based on bidirectional fitting method for collision avoidance of Unmanned Surface Vehicle

Radars and sensors are essential devices for an Unmanned Surface Vehicle (USV) to detect obstacles. Their precision has improved significantly in recent years with relatively accurate capability to locate obstacles. However, small detection errors in the estimation and prediction of trajectories of obstacles may cause serious problems in accuracy, thereby damaging the judgment of USV and affecting the effectiveness of collision avoidance. In this study, the effect of radar errors on the prediction accuracy of obstacle position is studied on the basis of the autoregressive prediction model. The cause of radar error is also analyzed. Subsequently, a bidirectional adaptive filtering algorithm based on polynomial fitting and particle swarm optimization is proposed to eliminate the observed errors in vertical and abscissa coordinates. Then, simulations of obstacle tracking and prediction are carried out, and the results show the validity of the algorithm. Finally, the method is used to simulate the collision avoidance of USV, and the results show the validity and reliability of the algorithm.