Chinese Journal of Ship Research, Volume. 16, Issue 1, 89(2021)

Trajectory planning and automatic obstacle avoidance algorithm for unmanned surface vehicle based on exact penalty function

Qingliang LI1, Bin LI2, Guohao SUN2, Xing CUI3, and Xintao MAO3
Author Affiliations
  • 1College of Electrical Engineering, Sichuan University, Chengdu 610065, China
  • 2School of Aeronautics and Astronautics, Sichuan University, Chengdu 610065, China
  • 3Beijing SunWise Space Technology Co., Ltd., Beijing 100194, China
  • show less

    Objectives

    Currently, how to plan the safe and efficient movement trajectory of an unmanned surface vehicle (USV) in local waters with multiple known obstacle positions is a research hotspot.

    Methods

    First, the obstacle areas are treated with simple and effective circular and convex quadrilateral envelopes, and the obstacle avoidance problem is transformed into the state inequality constraint of a time optimal control problem. The time optimal control problem is then transformed into an optimal parameter selection problem by control parameterization and time scale transformation. Finally, for multiple continuous state inequality constraints caused by multiple obstacles, the exact penalty function method is used to append all state constraints to the cost function. The final form of the problem is suitable for solving any effective optimization technique as a nonlinear optimization problem.

    Results

    The numerical simulation results show that the planned trajectory successfully avoids the obstacles in the water and conforms to the motion characteristics of USVs.

    Conclusions

    The results of this study can provide valuable references for the obstacle avoidance problem in USV trajectory planning.

    Tools

    Get Citation

    Copy Citation Text

    Qingliang LI, Bin LI, Guohao SUN, Xing CUI, Xintao MAO. Trajectory planning and automatic obstacle avoidance algorithm for unmanned surface vehicle based on exact penalty function[J]. Chinese Journal of Ship Research, 2021, 16(1): 89

    Download Citation

    EndNote(RIS)BibTexPlain Text
    Save article for my favorites
    Paper Information

    Category: Intelligent Navigation

    Received: Nov. 30, 2020

    Accepted: --

    Published Online: Mar. 27, 2025

    The Author Email:

    DOI:10.19693/j.issn.1673-3185.02209

    Topics