基于混合A*搜索和贝塞尔曲线的船舶进港和靠泊路径规划算法

Path planning for auto docking of underactuated ships based on Bezier curve and hybrid A* search algorithm

  • 摘要:
    目的 针对欠驱动无人艇自动进港和靠泊问题,提出一种基于混合A*搜索和贝塞尔曲线的路径规划算法。
    方法 该方法通过混合A*搜索在非结构化环境下快速搜索出一条满足无人艇非完整性约束且无碰撞风险的轨迹。在此基础上,基于广义沃罗诺伊图提出曲线优化算法,使得搜索算法得到的轨迹更加平滑且远离环境障碍物,从而引导无人艇在受限水域完成进港任务。同时,针对“最后一公里”靠泊问题,引入四阶贝塞尔曲线,用于生成靠泊路径从而引导船体平稳且精准入泊。
    结果 仿真和外场试验结果表明,无人艇能够实现自主避障且精准驶入泊位,靠泊精度指标均小于1.0。
    结论 所提路径规划算法能确保欠驱动无人艇实现进港和靠泊任务,可为智能船舶的进一步发展提供思路。

     

    Abstract:
    Objective This paper develops a multi-stage path planning algorithm for the auto docking operation of an underactuated surface vehicle (USV). As one of the most difficult tasks, docking requires advanced maneuvering skills. Therefore, it is necessary to generate a smooth trajectory in the berthing environment while maintaining control accuracy.
    Method The proposed method introduces a hybrid A* search algorithm in the pre-docking stage in which the well-known A* search algorithm is combined with the kinematic state space of the USV using the Reeds–Shepp curves, enabling it to produce sub-optimal paths that guarantee kinematic feasibility and low collision risk. For the docking stage, a cubic Bezier curve is introduced to represent the target path. The generated trajectories are then tested in numerical simulations wherein a mathematical model of a ship with two fixed propellers is established and verified.
    Results The simulation and experimental results show that the path planning and tracking performance of the method are satisfactory.
    Conclusion The proposed path planning method can contribute to automatic ship docking and the development of smart ships.

     

/

返回文章
返回