Equilibrium point smooth escape algorithm for local route of unmanned surface vehicles
For the problem of local equilibrium point in local path planning, a local equilibrium point smooth escape algorithm is proposed. In this method, a confirmation rule for obstructing obstacles is established to confirm obstacles obstructing routes of an unmanned surface vehicle and causing local equilibrium point from multiple detecting targets. A model for tracking point confirmation is constructed to guide the unmanned surface vehicle to bypass obstructing obstacles safely while tracking points. A tracking point smooth switching model is constructed to ensure smooth change of heading planned by the algorithm in tracking point switching. The idea of ‘wall-following’ algorithm and curve smoothing idea are integrated in the model and then a heading planning method escaping local equilibrium point is given. Simulation results show that the above algorithm can guide the unmanned surface vehicle out of the area where it is trapped when it falls into a local equilibrium point. The algorithm can improve the traceability of planned paths with a heading change rate much lower than that of conventional algorithms.