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

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

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

扫码查看
原文链接
  • 万方数据
为优化欠驱动船舶自动靠泊的轨迹规划问题,避免陷入局部最优,提出一种考虑船舶运动学模型整体约束和障碍物约束的实时轨迹规划方法.在栅格化地图基础上,基于A*算法规划全局最优路径,运用冗余点删除策略得到轨迹规划的参考航路点.考虑到船舶靠泊为动态过程,基于扩展动态窗口算法(EDWA)对船舶恒力阶段和减速阶段的靠泊轨迹进行预测,并引入比例积分微分(PID)控制方法调整船舶航向.对所有预测轨迹进行可行性检验后,利用考虑目标点、参考航路点和障碍物等约束的评价函数得到最优轨迹,其相对应的力作为船舶的控制输入.在下一个采样时间基于船舶当前的控制输入和运动状态重复以上步骤进行实时规划,直至船舶到达目标点.以日照港为仿真场景验证本文方法的可行性,结果表明,该方法能够在较短时间内引导船舶避开障碍物到达指定泊位,轨迹与最近障碍物的距离为144.1428 m,轨迹长度较传统A*+EDWA长47.26 m,但规划时间减少了55.12％,表明了本文方法的优越性.
To optimize the trajectory planning problem of un-deractuated ship automatic berthing and avoid getting stuck in local optima,a real-time trajectory planning method consider-ing the overall constraints of the ship kinematic model and ob-stacle 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 dy-namic 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 traj-ectories,the optimal trajectory was obtained by using an eval-uation function that considers constraints such as target points,reference waypoints,and obstacles,and the corre-sponding force was used as the control input for the ship. Re-peat the above steps for real-time planning based on the cur-rent control input and motion state of the ship at the next sam-pling time until the ship reached the target point. The feasibil-ity of the proposed method was verified by using the simulation scenario of Rizhao port. Results show that the proposed meth-od can guide ships to avoid obstacles and reach the designated berth in a relatively short time,the distance between the traj-ectory and the nearest obstacle is 144.1428 m,and the trajec-tory 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.

underactuated shipautomatic berthingtrajectory planningextended dynamic window algorithm (EDWA)proportional-integral-derivative (PID)

王紫凡、宋国宾、马枫、吴兵

展开 >

武汉理工大学水路交通控制全国重点实验室,武汉 430063

武汉理工大学 国家水运安全工程技术研究中心,武汉 430063

武汉理工大学 智能交通系统研究中心,武汉 430063

武汉理工大学交通与物流工程学院,武汉 430063

日照港引航站,山东 日照 276800

展开 >

欠驱动船舶 自动靠泊 轨迹规划 扩展动态窗口算法(EDWA) 比例积分微分(PID)

国家自然科学基金资助项目国家自然科学基金资助项目国家自然科学基金资助项目

519201050145207124852272422

2024

10.16411/j.cnki.issn1006-7736.2024.03.009

大连海事大学学报
大连海事大学

大连海事大学学报

CSTPCD北大核心
影响因子：0.469
ISSN：1006-7736
年,卷(期)：2024.50(3)