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

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