一种基于扰动流体动态系统的无人机三维航路规划方法
【专利摘要】本发明公开了一种基于扰动流体动态系统的无人机三维航路规划方法，将包含敌方地面防空火力的复杂地形环境下无人机低空飞行三维航路规划问题抽象为流体避障中的三维流线求解问题。该方法不需要求解带有复杂边界条件的流体方程，直接构造由于障碍物扰动所产生的流场方程，计算量较小。具体包括以下步骤：（1）将无人机飞行区域中的地形障碍、敌方雷达以及地面火力威胁用圆柱、圆锥、圆球和平行六面体等规则几何体进行等效，得到这些几何体障碍物的位置和表面方程；（2）在目标点处设置点汇，得到无障碍物扰动情况下的流场流速；（3）在已知障碍物位置和障碍物表面方程的条件下，根据障碍物的不可穿透条件，构造由于障碍物扰动后的流场流速；（4）从起始点处对流场流速进行积分，得到从起始点到目标点的避障流线，将此流线作为无人机的飞行航路；（5）控制无人机沿规划航路飞行。
【专利说明】一种基于扰动流体动态系统的无人机三维航路规划方法
【技术领域】
[0001]本发明涉及一种基于扰动流体动态系统的无人机三维航路规划方法，属于无人机导航制导与控制【技术领域】。
【背景技术】
[0002]无人机也称无人机航空器或遥控驾驶航空器，是一种由无线电遥控设备控制，或由预编程序操纵的非载人飞行器，拥有众多有人驾驶飞机所不具有的优点，具有广阔的应用前景。
[0003]侦察、监视、毁伤评估、对地攻击是无人机在军事领域的主要任务。此外，无人机还可担负航空遥感、资源探测、通信中继、灾害评估等任务，在民用领域发挥重大作用。随着无人机应用领域的不断扩大，要求提高无人机的自主飞行能力的呼声越来越高。
[0004]无人机航路规划是指为无人机寻找从起始点到目标点的安全可飞航路，它是影响无人机使用和飞行安全的关键技术，一直受到各方面的高度重视。随着无人机的使用空域从中、高空不断向低空、甚至超低空拓展，地形的影响将成为航路规划需要考虑的关键因素，此时传统的二维航路规划方法已无法满足需求，特别是对于执行低空突防任务的无人机，要实现地形跟随、地形回避和威胁回避(TF/TA2)，必须得到三维空间的突防航路。[0005]由于三维航路规划能够充分发挥无人机的机动飞行能力，在复杂地形条件下的低空突防、低空侦察或灾害感知等军、民用领域具有重要作用，许多学者进行了大量的研究。主要包括基于图形的规划方法、智能计算方法、人工势场法等。基于图形的规划方法将航路规划问题转化为一个网络图搜索问题，但规划出的航路可能带有尖角，不适合无人机直接飞行。智能计算方法如蚁群算法、进化算法和粒子群算法等，具有很强的发现较好解的能力，不容易陷入局部最优，但问题规模过大时经常导致算法收敛速度过慢或者得到的解不准确，此外还需要调整许多参数。人工势场法具有原理简单、计算量小的特点，但是在进行全局规划时容易产生局部极小问题。作为对传统人工势场法的一种改进，s Waydo等人提出了流函数法，该方法利用流体力学概念建立势场区域，能够很好地避免局部极小问题，同时具有光滑的航路特性和较快的计算速度。但是流函数的概念只存在于二维流场，无法用于三维航路规划，并且根据现有研究成果来看，障碍物只能为圆形障碍或其组合。
[0006]流函数法的基本思想是借鉴理想有势流体的绕流现象来实现对障碍物的规避，在流体力学中，绕流问题是通过控制方程和边界条件来描述的，对于理想有势流体，其控制方程为:
[0007]V 2Φ = O (I)
[0008]边界条件是:
[0009]在障碍物表面上:$ = O (2)
on
[0010]在无穷远处:VO=U00(3)
[0011]式中Φ表示流场的速度势，η表示障碍物表面上的单位外法向量，U00表示无穷远处流场流速的给定值。控制方程(I)是一个Laplace方程，其解Φ作为调和函数满足极值原理，其极值点只能出现在边界上，因此可以避免产生局部极小问题；边界条件(2)体现了障碍物的不可穿透条件，即在障碍物表面上流速沿法向量方向的分量为O，只具有沿切线方向的分量；边界条件(3)反映了障碍物对原始理想流场的扰动范围，即在无穷远处扰动趋于O。通过求解由以上三式构成的定解问题就可以得到整个规划区域的势场，对速度势求导即得流场各处的流场流速U，对流速积分所得流体的流线就是为无人机规划出的航路。尽管控制方程(I)的线性齐次性给问题的求解提供了便利，但是当障碍物形状较为复杂时，边界条件难于处理，往往无法得到方程的解析解，而如果通过数值方法求解不仅计算量大，而且前期的预处理繁琐。
【发明内容】
[0012]本发明的目的是为了解决上述问题，提出一种适用于圆球、圆柱、圆锥和平行六面体等凸形障碍及其组合情形下的三维航路规划方法，通过将复杂地形中的山峰、雷达和地面防空火力等抽象为圆柱、圆锥、圆球、平行六面体等典型障碍形状及其组合体，从而将包含敌方地面防空火力的复杂地形环境下无人机低空飞行三维航路规划问题抽象为流体避障中的三维流线求解问题。
[0013]一种基于扰动流体动态系统的无人机三维航路规划方法，具体包括如下步骤:
[0014]步骤一:将无人机飞行区域中的地形障碍、敌方雷达以及地面火力威胁用圆柱、圆锥、圆球和平行六面体等规则几何体进行等效，得到这些几何体障碍物的位置和表面方程;
[0015]步骤二:在目标点处设置点汇，得到无障碍物扰动情况下的流场流速；
[0016]步骤三:在已知障碍物位置和障碍物表面方程的条件下，根据障碍物的不可穿透条件，构造由于障碍物扰动后的流场流速；
[0017]步骤四:从起始点处对流场流速进行积分，得到从起始点到目标点的避障流线，将此流线作为无人机的飞行航路；
[0018]步骤五:控制无人机沿规划航路飞行。
[0019]本发明的优点在于:
[0020](I)本发明将传统的流函数法拓展到三维情形，并且可以处理多种形状的障碍物；
[0021](2)本发明直接通过构造障碍物扰动后的流场速度场，避免了求解带有复杂边界条件的流体方程；
[0022](3)采取本发明所提出的方法，可以得到平滑的三维航路，求解效率高，能较好的实现复杂地形环境下的运动规划。
【专利附图】
【附图说明】
[0023]图1是本发明的方法流程图；
[0024]图2是曲面方程近似的几何体障碍形状；
[0025]图3是无人机飞行区域地图；
[0026]图4是几何体等效后的无人机飞行区域地图；[0027]图5是本发明方法规划出来的无人机三维航路。
【具体实施方式】
[0028]下面将结合附图和实施例对本发明作进一步的详细说明。
[0029]无人机在进行低空突防时考虑的威胁因素主要包括:地形障碍(如山峰、山岭、高大建筑等)，敌方雷达、火力威胁等(如高炮、导弹等地面防空系统)。为降低航路规划算法的复杂性，将威胁信息用规则的几何体加以等效:独立的陡峭山峰视为圆锥，延绵的山脉视为长条状的平行六面体。高炮火力威胁视为从发射点到射程高度的圆柱体。防空导弹系统有相应的攻击区域，表示为由近边界到远边界的球体。雷达视为以雷达所处位置为球心，扫瞄半径为半径的半球体。为便于对圆球、圆柱、圆锥和平行六面体这四种障碍进行统一建模，考虑如下曲面方程:
[0030]
【权利要求】
1.一种基于扰动流体动态系统的无人机三维航路规划方法，具体包括以下几个步骤: (1)将无人机飞行区域中的地形障碍、敌方雷达以及地面火力威胁用圆柱、圆锥、圆球和平行六面体进行等效，得到几何体障碍物的位置和曲面方程； 地形障碍中:山峰设为圆锥，山脉设为平行六面体；地面火力威胁中:高炮火力威胁设为从发射点到射程高度的圆柱体，防空导弹系统的攻击区域设为由近边界到远边界的球体；敌方雷达设为以雷达所处位置为球心，扫瞄半径为半径的半球体； 设定曲面方程为:
2.根据权利要求1所述的一种基于扰动流体动态系统的无人机三维航路规划方法，步骤(4)中，积分采用欧拉法数值积分方法:设流线中一点的位置为(X，y, z)，积分步长为dt，则下一点的位置(X' , y' , Z1 )为:x' = x+uxdt,y/ = y+uydt,z/ = z+uzdt,式中 ux、ux和ux分别表示在xyz三轴方向上的分量。
【文档编号】G05D1/10GK103713642SQ201310722762
【公开日】2014年4月9日 申请日期:2013年12月24日 优先权日:2013年12月24日
【发明者】王宏伦, 吕文涛, 刘畅, 姚鹏 申请人:北京航空航天大学