An Improved Stanley Guidance Law for Large Curvature Path Following of Unmanned Surface Vehicle

Xiaofei Yang,Xin Yan,Wei Liu,Hui Ye,Zhaoping Du,Weibo Zhong
DOI: https://doi.org/10.1016/j.oceaneng.2022.112797
IF: 5
2022-01-01
Ocean Engineering
Abstract:In order to enhance the large curvature path following performance of unmanned surface vehicle (USV), an improved Stanley guidance law (ISGL) is proposed. To the best of our knowledge, we are the first to introduce the Stanley guidance law (SGL) to guidance subsystem of USV, and theoretically prove that it can be unified into one form with the line-of-sight (LOS). It is essentially a kind of LOS method with time-varying lookahead distance in the path-tangential reference frame. For the sake of accurately following the path with large curvature, a compensation angle (km/(1+|ye|))Δαm is integrated to improve the original SGL, which can evaluate the path curvature in advance and compensate the desired heading angle. The aim is to improve the heading angle error and make USV turn in advance. In order to verify path following performance of our algorithm, theoretical simulation and lake experiments are launched to compare to extended line-of-sight (ELOS), integral line-of-sight (ILOS) and original SGL algorithms. All the results show that our ISGL algorithm has better path following performance than others.
What problem does this paper attempt to address?