论文标题
USV-UAV的合作轨迹计划算法具有船体动态约束
Cooperative trajectory planning algorithm of USV-UAV with hull dynamic constraints
论文作者
论文摘要
在复杂的动态环境中,有效的轨迹产生在无人体表面车辆(USV)中仍然是一个开放的问题。通常,USV的感知通常会受到船体的秋千和环境天气的干扰,这使得计划最佳的USV轨迹具有挑战性。在本文中,提出了耦合USV-UAV系统的合作轨迹计划算法,以确保USV可以在多门图中的自主进步过程中执行安全,平稳的路径。具体而言,无人驾驶飞机(UAV)扮演飞行传感器的角色,通过轻巧的语义细分网络和3D投影转换提供实时的全球地图和障碍信息。然后,通过基于图的搜索方法生成了初始的避免轨迹。关于USV的唯一散入运动学特征,引入了基于船体动态约束的数值优化方法,以使该轨迹更易于跟踪进行运动控制。最后,提出了基于在执行过程中具有最低能量消耗限制的NMPC的运动控制方法。实验结果验证了整个系统的有效性,并且生成的轨迹在局部对于USV始终具有相当大的跟踪精度。
Efficient trajectory generation in complex dynamic environments remains an open problem in the unmanned surface vehicle (USV). The perception of the USV is usually interfered with by the swing of the hull and the ambient weather, making it challenging to plan the optimal USV trajectories. In this paper, a cooperative trajectory planning algorithm for the coupled USV-UAV system is proposed to ensure that USV can execute a safe and smooth path in the process of autonomous advance in multi-obstacle maps. Specifically, the unmanned aerial vehicle (UAV) plays the role of a flight sensor, providing real-time global map and obstacle information with a lightweight semantic segmentation network and 3D projection transformation. And then, an initial obstacle avoidance trajectory is generated by a graph-based search method. Concerning the unique under-actuated kinematic characteristics of the USV, a numerical optimization method based on hull dynamic constraints is introduced to make the trajectory easier to be tracked for motion control. Finally, a motion control method based on NMPC with the lowest energy consumption constraint during execution is proposed. Experimental results verify the effectiveness of the whole system, and the generated trajectory is locally optimal for USV with considerable tracking accuracy.