[发明专利]一种基于线性规划的实时动态航迹规划方法

说明书

技术领域

本发明涉及航迹规划技术领域，尤其涉及一种基于线性规划的实时动态航迹规划方法。

背景技术

近年来，无人直升机(Unmanned Aerial Vehicle,UAV)因为具有垂直起降、自主飞行等特点，适合代替人在危险、恶劣的环境中工作。使其运用不管是在军事方面还是民用方面都得到了空前的发展，这也是飞行器未来的一个发展趋势。无人直升机的一大特点就在于其无人驾驶，这就要求任务规划系统能够对无人直升机进行自主飞行控制。

航迹规划是无人机自主飞行的一项关键技术，它是在一定约束条件下(如飞行路径上的障碍物)，根据某个或者是某几个性能指标(如：时间最短，路程最短，燃油最省)，计算出从出发位置到终止位置的最优飞行轨迹。

由于无人机领域的发展，各类航迹规算法层出不穷，比如A*搜索算法、遗传算法、模拟退火算法、蚁群算法、粒子群优化算法、基于势能函数的算法等等。

中国专利CN201210274571.5，基于稀疏A*算法和遗传算法的航迹规划方法，将SAS算法和遗传算法相结合进行航迹规划。一定程度减少了航迹规划计算量。中国专利CN201310478422.5基于故障网格设计航迹规划算法，采用分布式技术实现计算加速。中国专利CN201310228497.8基于蜂群协同觅食算法设计多无人机航迹规划方法，提升航迹规划的稳定性，提高了搜索效率。

然后前面的这些专利虽然大都满足了航迹规划的实时性，最优性等特点，但是缺乏使用性，具体在实际运用中操作复杂，繁琐。

中国专利CN201110458232.8通过鼠标从高清地图上点航点，然后再判断航迹的飞行性，根据航迹判断结果手动拖动航点改变航迹，不需要手动输入航点，操作方便，实用性强。但是其航迹是通过手动选取的，然后在判断可行性，不断的修改得到一条可飞航迹，这严格意义上来说不能算是自动航迹规划，航迹规划只给定起始点和目标点，自动计算出从起点到终点的一条最优可飞航迹。

因此，现有技术中飞行器存在无法自动实现航迹规划的技术问题。

发明内容

本申请实施例通过提供一种基于线性规划的实时航迹规划方法，解决了现有技术中无法自动实现航迹规划的技术问题，进而实现了能够自动实现航迹规划的技术效果。

本申请实施例提供了一种基于线性规划的实时动态航迹规划方法，包括如下内容：

S101.在导航坐标系中，根据障碍物的形态特征坐标，获得障碍物边界坐标点所包含的坐标点集合；

S102.根据建立的离散时间模型，获得飞行器的动态参数约束集；

S104.基于障碍物边界坐标点所包含的坐标点集合以及飞行动态参数约束集，根据最优航迹目标函数，获得在导航坐标系中的航迹坐标点集。

进一步地，在S101之前还有：

对障碍物边界坐标点所包含的坐标点集，离散时间模型以及动态参数约束集进行初始化。

进一步地，S101具体包括：

在导航坐标系中，根据障碍物的形态特征坐标，判断障碍物是否为线性障碍物；

若判断获得为线性障碍物时，根据线性障碍物的避障约束面所构成的区域，获取避障面所构成的区域坐标点集合；

若判断获得为柱形障碍物时，获取柱形障碍物边界坐标点所包含的坐标点集合。

进一步地，S102具体为：根据建立的离散时间模型，飞行器的速度门限值以及加速度门限值，获得飞行的速度约束集和加速度约束集。

进一步地，S103具体为：采用AMPL语言编写成可调用程序对最优航迹目标函数，障碍物边界坐标点所包含的坐标点集合以及飞行动态参数约束集求解，获得飞行器在导航坐标系中的航迹坐标点集。

进一步地，在S103之后还有：

对应导航坐标系建立三维航迹规划坐标系；

将导航坐标系中飞行器的起点坐标作为三维航迹规划坐标系中的原点；

对应导航坐标系中的航迹坐标点集，依次在三维航迹规划坐标系中标出飞行器的航迹最优点集。

本申请实施例中提供的一个或多个技术方案，至少具有如下技术效果或优点：

由于采用了在导航坐标系中，根据障碍物的形态特征坐标，获得障碍物边界坐标点包含的坐标点集合；然后，根据建立的离散时间模型，获得飞行器的动态参数约束集；基于障碍物边界坐标点所包含的坐标点集合以及飞行动态参数约束集，根据最优航迹目标，获得在导航坐标系中由起点到达终点的航迹坐标点集，所以，有效解决了现有技术中无法自动实现航迹规划的技术问题，进而实现了能够自动实现航迹规划的技术效果。

附图说明