基于改进双向混合A*算法的船舶靠泊路径规划方法研究

Path planning for ship berthing based on improved bidirectional hybrid A* algorithm

  • 摘要:
    目的 旨在解决欠驱动船舶靠泊路径规划中存在的路径搜索效率低、路径终点航向及位置偏差大、安全性与可达性难以兼顾等问题。
    方法 通过构建面向船舶靠泊场景的双向混合A*路径搜索框架,并融合安全距离约束与动态路径拓展机制进行改进,提出一种基于改进双向混合A*算法(improved bidirectional hybrid A*,IBHA*)的船舶靠泊路径规划方法。首先,在考虑船舶运动约束和靠泊不同阶段速度变化的基础上,引入双向混合A*搜索机制,以提高搜索效率并确保终点位姿达到预期。其次,构建融合路径长度、转向操作及安全距离的多目标代价函数,以提升路径的安全性和航行效率。进而,采用带曲率约束的贝塞尔曲线对初始路径进行平滑处理,进一步提高路径的可行性与连续性。
    结果 仿真实验结果表明,与传统方法相比,所提出的IBHA*算法在保持良好航行安全性的同时,规划路径的平均长度缩短1.3%、平均搜索时间降低19.93%,且生成路径具有更优的终点位置及航向精度。
    结论 所提出的基于IBHA*算法的船舶靠泊路径规划方法能够在保持良好路径搜索效率的同时,生成兼顾航行安全性与稳定性的靠泊参考路径,为船舶的靠泊控制提供支撑。

     

    Abstract:
    Objective Automatic berthing path planning for underactuated ships is challenged by low search efficiency, large terminal position and heading errors, and the conflict between obstacle clearance and berth reachability. This study develops an improved bidirectional hybrid A* (IBHA*) algorithm that incorporates the changing maneuverability of a ship throughout the berthing process and generates a safe, smooth, and terminal-state-constrained reference path without dividing the task into separate planning stages.
    Method The navigation environment is first rasterized, and ship position and heading are jointly represented in the search state. Then, a bidirectional hybrid A* framework expands paths simultaneously from the initial ship state and the target berth state, reducing unnecessary node expansion and imposing terminal position and ship heading constraints from the beginning of the reverse search. To reflect the progressive reduction in speed and maneuverability during berthing, the maximum steering angle and expansion step are dynamically adjusted according to the Euclidean distance to the berth. Specifically, relatively large values are used in the early stage to preserve search efficiency, whereas smaller values are adopted near the berth to improve path resolution and heading alignment. A rectangular collision-detection boundary enlarged from the ship’s principal dimensions is used to account for hull size, underactuation, maneuvering delay, and path-following errors. In addition, a multi-objective cost function combines adaptively weighted path length, steering variation, and a dynamic safety-distance penalty. The safety threshold decreases as the ship approaches the quay, thereby maintaining sufficient obstacle clearance during transit while preserving access to the target berth. Forward and reverse paths are joined only when both distance and heading consistency criteria are satisfied. Finally, Bezier curves subject to maximum-curvature, positional-continuity, and tangential-continuity constraints smooth the initial path and suppress abrupt heading changes.
    Results Simulations using the 167m long underactuated vessel CISNE BLANCO were conducted in two berthing scenarios and compared with A*B and A*QB algorithms. IBHA* achieved zero terminal position error in both scenarios, with terminal heading errors of 0.00° and 0.08° and search times of 3.46s and 2.12s, respectively. Compared with A*B, which also considers obstacle clearance, IBHA* shortened the mean path length by 1.3%. Compared with A*QB, which performs better in terms of search efficiency among the existing methods, IBHA* reduced the mean search time by 19.93%. At the same time, the maximum steering angles of IBHA* remained within reasonable limits.
    Conclusion The proposed IBHA* ship berthing path planning method achieves a balance between search efficiency and feasibility. Its generated berthing paths consider both navigation safety and stability, providing reference paths for berthing control.

     

/

返回文章
返回