基于A*和扩展动态窗口算法的欠驱动船舶自动靠泊轨迹规划

展开
  • (武汉理工大学 a.水路交通控制全国重点实验室;b.国家水运安全工程技术研究中心;c.智能交通系统研究中心;d. 交通与物流工程学院, 武汉 430063;2.日照港引航站,山东 日照 276800) 

王紫凡(2001 — ),女,硕士生;吴兵*(1986 — ),男,博士,研究员,博士生导师,E-mail:bing.wu@whut.edu.cn

网络出版日期: 2024-09-19

基金资助

国家自然科学基金资助项目(51920105014;52071248;52272422)

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

摘要

为优化欠驱动船舶自动靠泊的轨迹规划问题,避免陷入局部最优,提出一种考虑船舶运动学模型整体约束和障碍物约束的实时轨迹规划方法。在栅格化地图基础上,基于A*算法规划全局最优路径,运用冗余点删除策略得到轨迹规划的参考航路点。考虑到船舶靠泊为动态过程,基于扩展动态窗口算法(EDWA)对船舶恒力阶段和减速阶段的靠泊轨迹进行预测,并引入比例积分微分(PID)控制方法调整船舶航向。对所有预测轨迹进行可行性检验后,利用考虑目标点、参考航路点和障碍物等约束的评价函数得到最优轨迹,其相对应的力对作为船舶的控制输入。在下一个采样时间基于船舶当前的控制输入和运动状态重复以上步骤进行实时规划,直到船舶到达目标点。以日照港为仿真场景验证本文方法的可行性,结果表明,该方法能够在较短时间内引导船舶避开障碍物到达指定泊位,轨迹与最近障碍物的距离为144.1428 m,轨迹长度较传统A*+EDWA长47.26 m,但规划时间减少了55.12%,表明了本文方法的优越性。

本文引用格式

王紫凡, 宋国宾, 马枫, 吴兵 . 基于A*和扩展动态窗口算法的欠驱动船舶自动靠泊轨迹规划[J]. 大连海事大学学报, 2024 , 50(3) : 78 -86 . DOI: 10.16411/j.cnki.issn1006-7736.2024.03.009

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.

参考文献

[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.
 
文章导航

/