[发明专利]一种绳系连接多飞行器离线轨迹生成方法

说明书

本发明涉及一种绳系连接多飞行器离线轨迹生成方法，属于飞行器轨迹规划研究领域。包括以下3个步骤：生成载荷的飞行轨迹；求解各个无人机和载荷的轨迹初始解参数；优化出满足约束条件的飞行轨迹。使用带有运动学约束的A*算法，搜索出一个比较优的初始轨迹解，从而减少了后端非线性优化的压力，并且更容易找到全局最优解而不是陷入局部最优解。通过加入绳索长度约束，使得无人机能够保持一定的阵型运输负载，同时也具有变队形避障的功能。后端非线性优化在不考虑时间成本的情况下将所有无人机以及负载的路径一起加入了优化变量中，使整个系统更容易达到全局最优。在离线环境下优化出一条近乎最优的路径，极大的减少了在线飞行中的路径优化压力。

技术领域

本发明属于飞行器轨迹规划研究领域，具体设计一种基于柔性连接的多飞行器离线生成轨迹的方法。

背景技术

近年来，无人机的应用市场越来越广泛，应用环境越来越恶劣。纯粹的手动飞行模式已经不能满足无人机在复杂环境下的飞行任务的需求，所以对于无人机的轨迹规划成为了一种必然的需求。生成一条从起点到目标点的轨迹正是无人机能够进行自主飞行的前提条件，相较于单无人机轨迹规划，多无人机编队协同飞行既要考虑每一个无人机避障、能量消耗、运动学限制上的约束，还需要考虑整个无人机队形的保持以及变形，相互之间的防碰撞等约束。

相比较于单无人机，多无人机协同作业能够提供更好的系统通用性、安全性和可部署性，并且能够降低系统的整体成本。例如在无人机运输负载这一应用场景上，单无人机的负载能力有限或过于昂贵，能量消耗速度快。而使用多无人机协同搬运负载可以减少系统的整体成本，增加系统的运输能力和鲁棒性。代价是需要复杂的轨迹规划算法来生成各个无人机的轨迹，要在保证系统整体负载能力的前提下还能够达到各无人机与负载避障的效果。

目前面向多无人机编队飞行任务的轨迹规划方法一般有两种：一种是先生成一架无人机的离线飞行轨迹，然后通过编队阵型仿射变换推导出其余无人机的离线飞行轨迹，然后在线飞行过程中通过局部轨迹优化实时调整各无人机的位置以达到避障的目的。例如，申请号为CN201910173841.5的中国专利提出了一种基于模型预测控制的多无人机编队协同控制方法，他在首先根据多无人机编队控制相关约束，初始化任务要求和相关控制参数，然后仅仅对领航无人机进行初步航迹规划，之后就直接进入了在线的轨迹实施优化过程。这种方式生成的离线轨迹可能会使队形中的某些无人机不满足避障约束，然而多无人机绳索连接协同搬运负载的情况要考虑更多的约束并且约束的精度要求更高，此时将更多的轨迹优化压力放在了在线飞行过程中，对低性能的嵌入式平台要求更高，增加了这种协同运输任务的难度。另一种是先使用一种不考虑运动学的路径搜索方法生成一条无人机的初始飞行轨迹，然后扩展出多条无人机的路径，或者不指定初始轨迹，接下来再进行多无人机的协同路径规划。例如申请号为CN201910395051.1的中国专利提出了一种多无人机多蚁群协同搜索目标方法，他并没有生成一个初始的轨迹就直接使用蚁群算法进行多无人机协同轨迹优化。这种方法使得非优化算法容易陷入局部极小值，并且在有狭窄障碍物时会降低优化成功率。

发明内容

要解决的技术问题

为了避免现有技术的不足之处，本发明提出一种针对多无人机于负载通过柔性绳索连接，在协同运输负载的约束下离线生成轨迹的方法。旨在实现多无人机协同运输系统的离线可行性轨迹，减少在线局部轨迹优化压力。

技术方案

一种绳系连接多飞行器离线轨迹生成方法，其特征在于步骤如下：

步骤1：生成载荷的飞行轨迹

1.1)获取地图信息：通过获取实际环境中的危险区域与安全区域大小，建立一个带有边界大小约束的全局地图，然后对地图中的危险区域以及安全区域进行栅格化赋值，得到全局地图；