Automatic berthing trajectory planning for an underactuated ship based on A* and extended dynamic window algorithm

Expand
  • (1a. State Key Laboratory of Maritime Technology and Safety (SKL MTS);1b. Intelligent Transportation Systems Research Center;1c. National Engineering Research Center for Water Transport Safety;1d. School of Transportation and Logistics Engineering,Wuhan University of Technology, Wuhan 430063,China;2. Rizhao Port Pilot Station,Rizhao 276800,China)


Online published: 2024-09-19

Abstract

To optimize the trajectory planning problem of underactuated ship automatic berthing and avoid getting stuck in local optima, a real-time trajectory planning method considering the overall constraints of the ship kinematic model and obstacle constraints was proposed. Based on the gridded map, the A* algorithm was used to plan the global optimal path, and the redundant point deletion strategy was applied to obtain the reference waypoints for trajectory planning. Considering that ship berthing was a dynamic process, the extended dynamic window algorithm (EDWA) was used to predict the berthing trajectory of the ship during the constant force stage and deceleration stage, and the proportional integral derivative (PID) control method was introduced to adjust the ship’s heading. After conducting feasibility tests on all predicted trajectories, the optimal trajectory was obtained by using an evaluation function that considers constraints such as target points, reference waypoints, and obstacles, and the corresponding force was used as the control input for the ship. Repeat the above steps for realtime planning based on the current control input and motion state of the ship at the next sampling time until the ship reached the target point. The feasibility of the proposed method was verified by using the simulation scenario of Rizhao port. Results show that the proposed method can guide ships to avoid obstacles and reach the designated berth in a relatively short time, the distance between the trajectory and the nearest obstacle is 144.1428 m, and the trajectory length is 47.26 m longer than the traditional A*+EDWA, however, the planning time is reduced by 55.12%, which show the superiority of the proposed method.

Cite this article

WANG Zifan, SONG Guobin, MA Feng, WU Bing . Automatic berthing trajectory planning for an underactuated ship based on A* and extended dynamic window algorithm[J]. Journal of Dalian Maritime University, 2024 , 50(3) : 78 -86 . DOI: 10.16411/j.cnki.issn1006-7736.2024.03.009

References

[1]CHENG T T, UTNE I B, WU B, et al. A novel system-theoretic approach for human-system collaboration safety: Case studies on two degrees of autonomy for autonomous ships[J]. Reliability Engineering & System Safety, 2023, 237: 109388.
[2]DU Z, NEGENBORN R R, REPPA V. Cooperative multi-agent control for autonomous ship towing under environmental disturbances[J]. IEEE/CAA Journal of Automatica Sinica, 2021, 8(8): 1365-1379.
[3]贾玉鹏, 神和龙, 尹勇, 等. 基于神经网络的无人船自主靠泊模拟研究[J]. 中国航海, 2021, 44(4): 107-117.
JIA Y P, SHEN H L, YIN Y, et al. Research on autonomous berthing simulation of unmanned ships based on neural networks[J]. Navigation of China, 2021, 44(4): 107-117. (in Chinese)
[4]李晔, 贾知浩, 张伟斌, 等. 面向无人艇自主靠泊的分层轨迹规划与试验[J]. 哈尔滨工程大学学报, 2019, 40(6): 1043-1050.
LI Y, JIA Z H, ZHANG W B, et al. Layered trajectory planning and testing for autonomous berthing of unmanned vessels[J]. Journal of Harbin Engineering University, 2019, 40(6): 1043-1050. (in Chinese)
[5]LIAO Y L, JIA Z H, ZHANG W B, et al. Layered berthing method and experiment of unmanned surface vehicle based on multiple constraints analysis[J]. Applied Ocean Research, 2019, 86: 47-60.
[6]YUAN S Z, LIU Z L, SUN Y X, et al. An event-triggered trajectory planning and tracking scheme for automatic berthing of unmanned surface vessel[J]. Ocean Engineering, 2023, 273: 113964.
[7]AHMED Y A, HASEGAWA K. Automatic ship berthing using artificial neural network trained by consistent teaching data using nonlinear programming method[J]. Engineering Applications of Artificial Intelligence, 2013, 26(10): 2287-2304.
[8]IM N K, NGUYEN V S. Artificial neural network controller for automatic ship berthing using head-up coordinate system[J]. International Journal of Naval Architecture and Ocean Engineering, 2018, 10(3): 235-249.
[9]贾玉鹏, 尹勇, 朱忠显. 基于泊位坐标的无人船自主靠泊仿真研究[J]. 系统仿真学报, 2020, 32(10): 1910.
JIA Y P, YIN Y, ZHU Z X. Simulation research on autonomous berthing of unmanned ships based on berth coordinates[J]. Journal of System Simulation, 2020, 32(10): 1910. (in Chinese)
[10] MIYAUCHI Y, SAWADA R, AKIMOTO Y, et al. Optimization on planning of trajectory and control of autonomous berthing and unberthing for the realistic port geometry[J]. Ocean Engineering, 2022, 245: 110390.
[11] 谭智坤, 张隆辉, 刘正锋, 等. 融合改进动态窗口法与速度障碍法的无人船局部路径规划[J]. 船舶力学, 2023, 27(3): 311-322.
TAN Z K, ZHANG L H, LIU Z F, et al. Unmanned ship local path planning based on improved dynamic window algorithm and velocity obstacle method[J]. Ship Mechanics, 2023, 27(3): 311-322. (in Chinese)
[12] 宁君, 马昊冉, 李铁山. 基于改进人工势场法的船舶路径规划与跟踪控制[J]. 哈尔滨工程大学学报, 2022, 43(10): 1414-1423.
NING J, MA H R, LI T S. Ship path planning and tracking control based on improved artificial potential field method[J]. Journal of Harbin Engineering University, 2021, 43(10): 1414-1423. (in Chinese)
[13] GAO P, ZHOU L, ZHAO X, et al. Research on ship collision avoidance path planning based on modified potential field ant colony algorithm[J]. Ocean & Coastal Management, 2023, 235: 106482.
[14] CHEN P F, HUANG Y M, PAPADIMITRIOU E, et al. Global path planning for autonomous ship: A hybrid approach of Fast Marching Square and velocity obstacles methods[J]. Ocean Engineering, 2020, 214: 107793.
[15] 陈志超, 薛圻蒙, 罗凯, 等. 基于改进LOS导航算法的智能船舶自动靠泊控制研究[J]. 中国航海, 2021, 44(2): 126-133.
CHEN Z C, XUE Q M, LUO K, et al. Research on intelligent ship automatic berthing control based on improved LOS navigation algorithm[J]. Navigation of China, 2021, 44(2): 126-133. (in Chinese)
[16] 张强, 张显库. 船舶自动靠泊控制研究综述[J]. 大连海事大学学报, 2015, 41(3): 1-9.
ZHANG Q, ZHANG X K. Summary of research on automatic berthing control of ships[J]. Journal of Dalian Maritime University, 2015, 41(3): 1-9. (in Chinese)
[17] SUN X J, WANG G F, FAN Y S, et al. Collision avoidance control for unmanned surface vehicle with COLREGs compliance[J]. Ocean Engineering, 2023, 267: 113263.
[18] XIE L, XUE S F, ZHANG J F, et al. A path planning approach based on multi-direction A* algorithm for ships navigating within wind farm waters[J]. Ocean Engineering, 2019, 184: 311-322.
[19] 余文凯, 章政, 付雪画, 等. 基于地图预处理及改进A*算法的路径规划[J]. 高技术通讯, 2020, 30(4): 383-390.
YU W K, ZHANG Z, FU X H, et al. Path planning based on map preprocessing and improved A* algorithm[J]. Chinese High Technology Letters, 2020, 30(4): 383-390. (in Chinese)
[20] HAN S, WANG Y T, WANG L, et al. Automatic berthing for an underactuated unmanned surface vehicle: A real-time motion planning approach[J]. Ocean Engineering, 2021, 235: 109352.
[21] FOSSEN T I. Handbook of marine craft hydrodynamics and motion control[M]. John Wiley & Sons, 2011.
[22] DANIEL K, NASH A, KOENIG S, et al. Theta*: Any-angle path planning on grids[J]. Journal of Artificial Intelligence Research, 2010, 39: 533-579.
 
Outlines

/