CN102622653B - 风场影响下微型无人飞行器的多分辨率路径规划方法 - Google Patents

风场影响下微型无人飞行器的多分辨率路径规划方法 Download PDF

Info

Publication number
CN102622653B
CN102622653B CN201210046577.7A CN201210046577A CN102622653B CN 102622653 B CN102622653 B CN 102622653B CN 201210046577 A CN201210046577 A CN 201210046577A CN 102622653 B CN102622653 B CN 102622653B
Authority
CN
China
Prior art keywords
wind field
resolution
haar
function
represent
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Expired - Fee Related
Application number
CN201210046577.7A
Other languages
English (en)
Other versions
CN102622653A (zh
Inventor
龚光红
高栋栋
王江云
韩亮
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Beihang University
Original Assignee
Beihang University
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Beihang University filed Critical Beihang University
Priority to CN201210046577.7A priority Critical patent/CN102622653B/zh
Publication of CN102622653A publication Critical patent/CN102622653A/zh
Application granted granted Critical
Publication of CN102622653B publication Critical patent/CN102622653B/zh
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Landscapes

  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

本发明公开了一种风场影响下微型无人飞行器的多分辨率路径规划方法,该方法有六大步骤:步骤一:获取飞行器路径规划所需要的环境区域;步骤二:选取小波变换的基函数;步骤三:构建风场影响下的飞行环境代价函数;步骤四:利用Haar小波网格分解法重构多分辨率飞行环境代价函数;步骤五:利用多分辨率环境代价函数值生成环境加权图;步骤六:寻找最优路径。本发明方法在确定环境区域不同分辨率等级过程中考虑了机载计算机的计算能力、传感器的探测范围、障碍物的分布、风场的分布及强度等因素,提高了路径规划的效率,且该方法简单可靠实用,适合于风场影响下的低空微型无人飞行器在线路径规划。

Description

风场影响下微型无人飞行器的多分辨率路径规划方法
技术领域
本发明属于航空优化技术领域,尤其涉及微型无人飞行器路径规划技术领域,具体是一种风场影响下微型无人飞行器的多分辨率路径规划方法。
背景技术
微型无人飞行器作为一种相对低成本的特殊工具在民用和军用领域越来越受到重视。在一些危险地区或人类难以涉足的地区,微型无人飞行器具有很大优势,可以用来侦查重要军事设施,监视实时灾害和交通状况,搜寻和搜救工作等。微型无人飞行器由于体积小,重量轻,有效载荷小,使得机载计算机的计算能力和传感器性能受到限制。计算能力的限制要求微型无人飞行器中算法的计算量要小,传感器的性能限制了侦查空间的有效范围,因此,针对微型无人飞行器设计一种高效实时的路径规划算法对实际应用有重要意义。
由于传感器性能的限制,微型无人飞行器通常工作在低空区域,需要规避建筑物和树木等障碍物,同时,由于微型无人飞行器重量轻,飞行路径极易受到风场的影响,这使得其路径规划更加具有挑战性。但现有技术中,针对低空的微型无人飞行器的路径规划,面临着计算能力、传感器性能有限,并且易受风场影响等实际问题。
发明内容
本发明针对现有低空微型无人飞行器在路径规划中面临的计算能力、传感器性能有限和易受风场影响等实际问题,提供了一种风场影响下微型无人飞行器的多分辨率路径规划方法,利用小波变换进行环境区域网格的多层次分解,从而设计了一种适合低空飞行的微型无人飞行器在线路径规划方法,提高了在线规划的效率和鲁棒性。
本发明提出的一种风场影响下微型无人飞行器的多分辨率路径规划方法,通过如下步骤来实现:
步骤1:获取飞行器路径规划所需要的环境区域。
步骤2:选取哈尔(Haar)小波变换基函数,构建二维空间的Haar小波基函数,并得到用二维空间的小波变换基函数对二元函数近似逼近的函数。
步骤3:考虑飞行器与障碍物之间的距离、风场的强度、以及风场的梯度三种因素的影响,构建飞行环境代价函数。
步骤4:利用Haar小波网格分解法重构多分辨率飞行环境代价函数。
步骤5:确定各网格单元的飞行环境代价函数值,将环境区域根据障碍物与非障碍物的表示值,以及飞行环境代价函数值生成环境加权图,将多分辨率路径规划问题转化为图的搜索问题。
步骤6:基于A*或Dijkstra搜索方法寻找最优路径。
所述步骤1中获取微型无人飞行器路径规划所需要的环境区域由如下步骤完成:
步骤1.1:将飞行器所处的三维环境空间区域,从高度方向上分解为不同层次的二维欧氏空间,所得到的二维欧氏空间就是所需要的环境区域;
步骤1.2:将得到的二维欧氏空间根据地形高程和飞行器可飞行高度,划分为障碍区和非障碍区,并确定飞行器的初始位置和目标位置;对原始数字地形高程图中第i点位置Xi表示如下:
其中,表示障碍物空间,表示非障碍物空间,zi表示位置Xi的地形高程,H表示飞行器的可飞行高度;
步骤1.3:将环境区域归一化为单位方形区域,并进行网格划分。
所述步骤2中构建二维空间的小波变换基函数以及用二维空间的小波变换基函数对二元函数近似逼近的方法具体是:
步骤2.1:选取一维空间的Haar基本小波,将Haar基本小波通过伸缩和平移操作得到一组形状相似的小波,得到一维空间的Haar小波基函数:
φ i j ( x ) = 2 j φ ( 2 j x - i ) , ψ i j ( x ) = 2 j ψ ( 2 j x - i )
j=0,1,…Jmaxand i=0,1,…,2j-1
其中,j表示分辨率等级,2j表示伸缩因子,i表示平移量, 分别表示伸缩和平移后的Haar尺度函数和Haar母小波函数,x表示一维空间的位置变量;
步骤2.2:由一维空间的Haar小波基函数构造二维空间的Haar小波基函数如下:
Φ m , n j ( x , y ) = φ m j ( x ) φ n j ( y )
Ψ m , n 1 , j ( x , y ) = φ m j ( x ) ψ n j ( y )
Ψ m , n 2 , j ( x , y ) = ψ m j ( x ) φ n j ( y )
Ψ m , n 3 , j ( x , y ) = ψ m j ( x ) ψ n j ( y )
其中,(x,y)表示二维空间的位置变量,m,n为二维空间两个方向的位置标号;表示二维空间的Haar尺度函数,表示在n方向的Haar母小波函数,表示在m方向的Haar母小波函数,表示在对角线方向的Haar母小波函数;
步骤2.3:将任意一个二元函数用二维空间的Haar小波基函数近似逼近,得到:
其中,J表示最低分辨率等级,表示整数;为近似逼近中二维空间Haar尺度函数的系数, λ m , n j = ∫ - ∞ ∞ ∫ - ∞ ∞ f ( x , y ) Φ m , n j ( x , y ) dx dy ; 为近似逼近中二维空间Haar母小波函数的系数,不同层次逼近的形式就是多分辨表示的形式,逼近分为两部分,步骤2.3得到的式子的右边的第一项对f(x,y)的粗略近似,右边的第二项包含了f(x,y)的更多细节信息。
所述的步骤3中所构建的飞行环境代价函数f(X)为:
f(X)=α·rm1(X)+β·rm2(X)+γ·rm3(X)
其中,X表示当前飞行器的位置坐标,α,β和γ是调节三种因素在代价函数中相对重要性的参数,取值范围为0~1之间;rm1(X)表示飞行器与障碍物之间的距离因素对飞行环境的影响,rm2(X)表示风场的强度对飞行环境的影响,rm3(X)表示风场的梯度对飞行环境的影响。
所述步骤4中利用Haar小波网格分解法重构多分辨率飞行环境代价函数由如下步骤完成:
步骤4.1:根据原始数字地形高程图的分辨率和机载计算机的计算资源确定环境区域表示的最高分辨率等级Jmax,根据规划问题的具体需求确定环境区域表示的最低分辨率等级Jmin
步骤4.2:将任意一个分辨率等级的网格单元、同一层次分辨率区域范围、以及同一层次分辨率区域中心坐标进行公式化表示;
步骤4.3:将步骤3得到的飞行环境代价函数,采用步骤2中的二维空间的Haar小波变换基函数近似逼近,重构多分辨率飞行环境代价函数。
所述的步骤5中生成的环境加权图,该环境加权图中的每个节点对应一个网格单元,节点的值表示该处是障碍物还是非障碍物,如果两个网格单元相邻,则用相应的两个节点的边来表示,边上的值表示从一个节点转移到另一个节点的飞行环境代价函数的值。
本发明方法的优点和积极效果在于:
(1)采用多分辨率路径规划减少了环境表示的数据量,在满足规划要求的条件下,降低了对机载计算资源的消耗,提高了在线规划的实时性,且本发明的方法简单可靠实用,易于操作,适合于风场影响下的低空微型无人飞行器在线路径规划;
(2)考虑了风场对低空微型无人飞行器路径规划的影响,多分辨率表示可以使微型无人飞行器更好地规避风场的影响;在确定环境区域不同分辨率等级过程中考虑了机载计算机的计算能力、传感器的探测范围、障碍物的分布、风场的分布及强度等因素,提高了路径规划的效率和鲁棒性。
附图说明
图1为本发明的多分辨率路径规划方法的整体步骤流程图;
图2为一个原始数字地形高程图的示例;
图3为采用本发明方法多分辨率表示环境区域的示意图;
图4为未采用多分辨率和采用多分辨率后的路径规划运行时间效率曲线;
图5为未考虑风场影响下的路径规划效果图;
图6为考虑了风场影响后的路径规划效果图。
具体实施方式
下面结合附图和实施例对本发明的方法进行具体说明。
本发明方法的主要思想是:在路径环境模型表示满足一定逼真度和精确度的前提下,根据机载计算机计算能力、机载传感器性能和环境详细信息对环境区域采用不同细节层次的模型表示,减少环境模型的复杂度和计算量,取得环境模型表示的复杂度、逼真度、精确度和计算效率之间的折中。通过利用Haar小波函数对飞行器路径上的环境信息进行多分辨率表示,将环境空间划分成一系列依次嵌套的子空间来自动生成多尺度的空间表示,而且Haar小波变换可以使环境数据中包含的环境特征在不同尺度上被提取出来,保留了环境信息的结构特征,为路径规划的多分辨率处理与表达提供了有效方法。在环境区域的不同细节层次,即不同分辨率层次确定过程中,机载计算机的计算能力确定了分辨率的最高细节,传感器的探测范围和风场分布范围确定了分辨率的空间区域,障碍物分布、风场强度、风场变化程度确定了分辨率的不同等级。
如图1所示,本发明的风场影响下微型无人飞行器的多分辨率路径规划方法可以按照如下步骤完成:
步骤一:获取飞行器路径规划所需要的环境区域。
步骤1.1:三维空间可以从高度方向上分解为不同层次的二维空间,假设微型无人飞行器路径规划所需要的环境区域为二维欧氏空间,表示为
步骤1.2:飞行器不可穿越的山体、建筑等障碍物空间表示为则非障碍物空间表示为路径规划问题抽象为:如果无人飞行器的初始位置点为和目标位置点为在空间中寻找一系列的可飞行位置点,以满足一定的约束条件和目标条件。本发明实施例中选用的环境区域为1024×1024像素的数字地形高程图。当地形高程qi高于飞行器可飞行高度H,则该区域为障碍物区域;当地形高程qi低于飞行器可飞行高度H,该区域为无障碍物区域,可采用式(1)表示:
Xi表示数字地形高程图中的某一点位置,qi表示位置Xi的地形高程。所述的飞行器可飞行高度H是微型无人飞行器安全飞行的最低高度(相对于海平面),低于此高度飞行则可能发生危险。
步骤1.3:为了使算法的描述具有可读性,不失一般性,环境区域归一化为单位方形区域,表示为[0,1]×[0,1],可以分解的最精细网格为2N×2N,间隔为1/2N,由于原始地形图为1024×1024像素,所以选取的N=10。如果最高分辨等级为Jmax,则Jmax不能大于N。
如图2所示,为一个原始数字地形高程图,原始数字地形高程图的分辨率决定了可以达到的最精细网格,环境区域表示的最高分辨率受最精细网格划分的限制。
步骤二:选取小波变换的基函数。
步骤2.1:选取Haar基本小波,确定一维空间的Haar小波基函数。
在多分辨率建模过程中,环境代价函数是通过小波变换基函数来逼近重构的,不同层次的逼近代表不同等级的分辨率。选择合适的小波变换基函数对环境代价函数进行逼近,使得小波变换能方便准确地描述多分辨率环境空间的特征。本发明中选用Haar小波基函数,Haar小波基函数是最简单适用的具有紧支撑性的正交小波函数。由于环境区域为二维欧氏空间,可由一维空间的Haar小波基函数构造二维空间的小波基函数。一维空间中的Haar基本小波表示为:
φ ( x ) = 1 x ∈ [ 0,1 ) 0 x ∉ [ 0,1 ) , ψ ( x ) = 1 x ∈ [ 0,1 / 2 ) - 1 x ∈ [ 1 / 2,1 ) 0 x ∉ [ 0,1 ) - - - ( 2 )
其中,φ(x)表示Haar尺度函数,ψ(x)表示Haar母小波函数,x表示一维空间的位置变量。
将式(2)通过伸缩和平移操作得到一组形状相似的小波,得到一维空间的Haar小波基函数:
φ i j ( x ) = 2 j φ ( 2 j x - i ) , ψ i j ( x ) = 2 j ψ ( 2 j x - i ) (3)
j=0,1,…and i=0,1,…,2j-1
其中,j表示伸缩因子2j的指数,能表征分辨率等级,i表示平移量,表示伸缩和平移后的Haar小波基函数。
步骤2.2:构造二维空间的Haar小波基函数,二维空间的小波基函数为多分辨率表示的基本元素。根据式(3)构造二维空间的Haar小波基函数如式(4)所示:
Φ m , n j ( x , y ) = φ m j ( x ) φ n j ( y )
Ψ m , n 1 , j ( x , y ) = φ m j ( x ) ψ n j ( y ) (4)
Ψ m , n 2 , j ( x , y ) = ψ m j ( x ) φ n j ( y )
Ψ m , n 3 , j ( x , y ) = ψ m j ( x ) ψ n j ( y )
上式中上标j可表示分辨率的等级,j越大,可以包括更多的细节信息,分辨率的等级越高;m,n为二维空间两个方向的位置标号,(x,y)表示二维空间的位置变量,表示二维空间的Haar尺度函数,表示在n方向的Haar母小波函数,表示在m方向的Haar母小波函数,表示在对角线方向的Haar母小波函数。
步骤2.3:将任意一个二元函数用二维空间的小波基函数形式进行逼近,不同层次逼近的形式即为多分辨表示的形式,逼近分为两部分,第一部分为粗略近似,第二部分为细节近似。任意一个函数用式(4)近似逼近为:
(5)
其中,为近似逼近中二维空间Haar尺度函数的系数,为近似逼近中二维空间Haar母小波函数的系数,具体根据式(6)得到:
λ m , n J min = ∫ - ∞ ∞ ∫ - ∞ ∞ f ( x , y ) Φ m , n J min ( x , y ) dx dy (6)
式(5)中等式右边的第一项是对f(x,y)的粗略近似,近似等级为Jmin,第二项包含了f(x,y)的更多细节信息。Jmin为最低分辨率等级,表示整数,为在二维空间上绝对平方可积的函数集合。
步骤三:构建风场影响下的飞行环境代价函数。
本发明的飞行环境代价函数定义在环境区域上,由三种因素共同影响,分别为微型无人飞行器与障碍物之间的距离、风场的强度、以及风场的梯度。飞行器与障碍物之间的距离因素对飞行环境的影响rm1(X)采用公式(7)表示为:
其中X表示当前微型无人飞行器的位置坐标,Y表示障碍物的位置坐标。飞行器与障碍物的距离越近,飞行威胁越大。
风场强度对飞行环境的影响rm2(X)如公式(8)所示:
其中Vp是非障碍物空间中任意一点p的风场速度。Vmax计算出区域中最大的风场强度,||VZ||∞计算出在Z点处的风场强度,所述的风场强度是指风场速度的数值大小。飞行器距离风场越近,风场强度越大,则飞行威胁越大。
风场梯度对飞行环境的影响rm3(X)采用公式(9)表示如下:
其中 是非障碍物空间中任意一点p的风场梯度。计算出区域中风场中的最大梯度,计算出在Z点处风场的梯度。风场梯度越大,飞行威胁越大。
如果微小型无人飞行器当前的位置坐标为X=(x,y),rm1(X)可以反映位置Y处的障碍物对飞行器的碰撞威胁,主要和飞行器和障碍物之间的距离有关;rm2(X)和rm3(X)分别反映了位置Z处的风场强度和风场变化强度对飞行器的影响,都为指数函数形式,可以看出影响大小除了与风场强度和风场变化有关外,还与风场与飞行器的距离有关。
三种因素综合影响下的飞行环境代价函数构建为:
f(X)=α·rm1(X)+β·rm2(X)+γ·rm3(X)            (10)
其中α,β和γ是调节三种因素在代价函数中相对重要性的参数,取值范围为0~1之间。
步骤四:利用Haar小波网格分解法重构多分辨率飞行环境代价函数。
步骤4.1:在利用Haar小波网格分解法重构多分辨率飞行环境代价函数过程中,最高分辨率等级Jmax和最低分辨率等级Jmin的选择由机载计算资源和问题的具体需求有关,根据原始数字地形高程图的分辨率和机载计算机的计算资源确定环境区域表示的最高分辨率,根据规划问题的具体需求确定环境区域表示的最低分辨率。
步骤4.2:将任意一个分辨率等级的网格单元、同一层次分辨率区域范围、以及同一层次分辨率区域中心坐标进行公式化表示。
环境区域中的任意一个等级的分辨率j,满足Jmin≤j≤Jmax。在分辨率等级为j时,网格间隔为1/2j,任一单元网格可以表示为:
上式中, h m j = [ m / 2 j , ( m + 1 ) / 2 j ] , 表示在分辨率等级为j情况下,m方向的空间间隔,表示在分辨率等级为j情况下,n方向的空间间隔, h n j = [ n / 2 j , ( n + 1 ) / 2 j ] . 在j分辨率等级下的网格点中心坐标集合为:
式(12)中rj表示在j分辨率等级下的区域范围,rj>rj+1,较高分辨率等级区域嵌套在较低分辨率等级区域中,Y表示环境区域中的某一个位置坐标。
步骤4.3:将步骤三得到的飞行环境代价函数,按步骤二中的二维空间的Haar小波变换基函数近似逼近,进行Haar小波网格分解法重构。
环境代价函数可以由Haar小波分解为:
其中,N(Jmin)表示在分辨率等级为Jmin的情况下的位置标号的取值集合,具体可将Jmin代入式(14)中可得到:
N(j)表示在分辨率等级为j情况下,位置标号的取值集合。
G(j)表示在分辨率等级为j情况下,考虑了障碍物和风场区域后,m方向的位置标号取值序列,根据式(15)得到:
(15)
H(j)表示在分辨率等级为j情况下,考虑了障碍物和风场区域后,n方向的位置标号取值序列,根据式(16)得到:
(16)
式(15)和式(16)中,X=(x,y),Z=(zx,zy)分别是微型无人飞行器和风场中心位置的坐标。从G(j)和H(j)可以看出,离飞行器和风场越近的环境区域,表示的分辨率越高。
步骤五:利用多分辨率环境代价函数值生成环境加权图。
通过式(13)将飞行环境代价函数分解为多分辨率形式,分解的单元网格结果与环境加权图G=(V,E)对应,V表示图中节点的集合,E表示节点之间边的集合。每个网格单元对应加权图中相应的一个节点,如果两个网格单元相邻则用相应的两个节点的边来表示。节点的值表示该处是障碍物还是非障碍物,若是障碍物用表示障碍物空间的符号来标记该节点的值,若是非障碍物用表示非障碍物空间均符号标记该节点的值,边上的值表示从一个节点转移到另一个节点的飞行环境代价函数f(X)的值。对于两个相邻的网格单元,对应的两个节点间会有边,边是有方向的,边上的值为第一个节点所指向的第二个节点的飞行环境代价函数的值。
步骤六:基于A*或Dijkstra搜索方法寻找最优路径。
生成环境加权图后,即可以利用常用的A*或Dijkstra搜索方法来寻找最优路径。
通过上述方法的描述可以看出,由于低空飞行的微型无人飞行器计算能力和传感器性能有限,而且飞行路径易受风场的影响,利用Haar小波网格分解法重构的多分辨率路径规划可以减少环境表示的数据量,降低机载计算资源的消耗,提高在线规划实时性。根据飞行器与障碍物之间的距离关系,风场的位置、强度及变化程度确定环境多分辨率表示的范围和等级,有效地考虑了风场对低空微型无人飞行器路径规划的影响,使微型无人飞行器更好地规避障碍物和风场。
本发明方法用计算机程序实现描述:微型无人飞行器在初始时刻t=t0的位置为x(t0)=x0,在每个时间步长ti(i=0,1,…)构建环境区域的多分辨率网格分解,该分解结果与ti时刻的环境加权图Gi=(Vi,Ei)相对应。针对环境加权图,在每个时间步长内迭代执行A*或Dijkstra搜索方法,则得到不同时刻的位置序列{x(t0),x(t1),…,x(tf)},该过程直到满足条件||x(tf)-xf||<1/2J max时结束。x(tf)表示微型无人飞行器在时刻tf的位置。
上述设计方法在Intel Pentium(R)双核2.40GHz处理器,2.0G物理内存上实现,软件条件为Matlab R2010a,对未经过多分辨率表示的环境区域和本发明提出的多分辨表示环境区域进行微型无人飞行器路径规划仿真,通过对运行时间的比较,如图4与表1所示,可以看出:在环境区域比较小时,采用未经过多分辨率表示的环境区域进行微型无人飞行器路径规划仿真和采用本发明方法进行微型无人飞行器路径规划仿真的运行时间相差不大,但随着环境区域的扩大,采用本发明方法进行路径规划的时间明显小于采用未经过多分辨率表示的环境区域情况下的路径规划的运行时间,从而看出,采用本发明方法提高了微型无人飞行器路径规划的运行效率。实验结果如表1所示:
表1两种方法运行时间的影响
图2为路径规划原始地形高程图颜色较暗区域对应较高的地形高程,颜色较亮区域对应较低的地形高程。图3为路径规划环境区域多分辨率表示的示意图,多分辨率表示采用的最高分辨率要低于原始地形高程图的分辨率,图中用三个等级的分辨率表示环境区域,星号标识为微型无人飞行器的当前位置,在远离飞行器的环境区域方向上分辨率等级逐步降低。
图5和图6中的圆圈和方块分别标识为微型无人飞行器的初始位置和目标点位置,两个位置点之间的连线为微型无人飞行器规划的路径,图5给出了未考虑风场影响下的路径规划效果图,在时间t=t30时,飞行器周围环境采用了三种分辨率表示;图6给出了考虑了风场影响下的路径规划效果图,在时间t=t35时,飞行器周围环境和风场环境采用了多分辨率表示,通过对图5,6的比较可以看出,由于考虑了风场的分布及强度,飞行器的在线规划轨迹得到了修正。
为了降低计算负担,提高微型无人飞行器路径规划的实时性,将微型无人飞行器的飞行环境用不同层次的分辨率表示,距离飞行器较近的障碍物和风场变化剧烈的区域采用较高分辨率,距离飞行器较远的障碍物和风场变化平缓的区域采用较低分辨率,这种表示方法使得需要处理的数据量减少,一方面提高了算法的实时性,另一方面考虑了风场对路径规划的影响,是一种简单实用的新方法。本发明方法通过将Haar小波网格分解理论应用于对飞行环境的多分辨率表示中,使得微型无人飞行器在距离障碍物和风场较近的区域,风场强度和梯度变化较大的区域采用较高的分辨率,这样既提高了飞行器在线规划的效率,解决了机载计算机计算资源有限的问题,又可以更加有效地规避障碍物和风场,减少路径上的环境威胁。本发明具有较强的实用性,为风场影响下低空飞行的微型无人飞行器在线路径规划提供了一种简单实用的新方法。

Claims (5)

1.一种风场影响下微型无人飞行器的多分辨率路径规划方法,其特征在于,本方法包括如下步骤:
步骤1:获取飞行器路径规划所需要的环境区域;具体本步骤包括如下步骤:
步骤1.1:将飞行器所处的三维环境空间区域,从高度方向上分解为不同层次的二维欧氏空间,所得到的二维欧氏空间就是所需要的环境区域;
步骤1.2:将得到的二维欧氏空间根据地形高程和飞行器可飞行高度,划分为障碍区和非障碍区,并确定飞行器的初始位置和目标位置;对原始数字地形高程图中第i点位置Xi的划分如下:
其中,表示障碍物空间,表示非障碍物空间,qi表示位置Xi的地形高程,H表示飞行器的可飞行高度;
步骤1.3:将环境区域归一化为单位方形区域,并进行网格划分;
步骤2:选取Haar小波变换基函数,构建二维空间的Haar小波基函数,并用二维空间的小波变换基函数对二元函数f(x,y)近似逼近,得到:
其中,(x,y)表示二维空间的位置变量,m,n为二维空间两个方向的位置标号,表示整数,Jmin表示最低分辨率等级;为近似逼近中二维空间Haar尺度函数的系数, λ m , n J min = ∫ - ∞ ∞ ∫ - ∞ ∞ f ( x , y ) Φ m , n J min ( x , y ) dxdy ; 为近似逼近中二维空间Haar母小波函数的系数, ξ m , n k , j = ∫ - ∞ ∞ ∫ - ∞ ∞ f ( x , y ) Ψ m , n k , j ( x , y ) dxdy ;
步骤3:考虑飞行器与障碍物之间的距离、风场的强度、以及风场的梯度三种因素的影响,构建飞行环境代价函数f(X):
f(X)=α·rm1(X)+β·rm2(X)+γ·rm3(X)   (3)
其中,X表示当前飞行器的位置坐标,X=(x,y),α,β和γ是调节三种因素在代价函数中相对重要性的参数,取值范围为0~1之间;rm1(X)表示飞行器与障碍物之间的距离因素对飞行环境的影响,rm2(X)表示风场的强度对飞行环境的影响,rm3(X)表示风场的梯度对飞行环境的影响;
步骤4:利用Haar小波网格分解法重构多分辨率飞行环境代价函数,包括如下步骤:
步骤4.1:根据原始数字地形高程图的分辨率和机载计算机的计算资源确定环境区域表示的最高分辨率等级Jmax,根据规划问题的具体需求确定环境区域表示的最低分辨率等级Jmin
步骤4.2:将任意一个分辨率等级的网格单元、同一层次分辨率区域范围、以及同一层次分辨率区域中心坐标进行公式化表示;
在分辨率等级为j的情况下,任一网格单元表示为:
k m , n j = Δ h m j × h n j - - - ( 4 )
其中,分辨率等级j满足条件:Jmin≤j≤Jmax分别表示在分辨率等级为j情况下,m方向、n方向的空间间隔, h m j = [ m / 2 j , ( m + 1 ) / 2 j ] , h n j = [ n / 2 j , ( n + 1 ) / 2 j ] ;
在分辨率等级为j的情况下,同一层次分辨率区域中心坐标的集合R(X,rj)为:
其中,rj表示在同一层次分辨率等级为j的情况下的区域范围,rj>rj+1,Y为某个位置坐标,表示环境区域;
步骤4.3:将步骤3得到的飞行环境代价函数,采用步骤2中的二维空间的Haar小波变换基函数近似逼近,得到多分辨率飞行环境代价函数,得到:
f ( X ) = Σ m , n ∈ N ( J min ) λ m , n J min Φ m , n J min ( X ) + Σ k = 1 3 Σ j = J min J max - 1 Σ m ∈ n ∈ H ( j ) G ( j ) ξ m , n k , j Ψ m , n k , j ( X ) - - - ( 6 )
其中,N(Jmin)表示在分辨率等级为Jmin的情况下的位置标号的取值集合,根据式(7)得到:
N ( j ) = Δ { 0,1,2 , . . . , 2 j - 1 } - - - ( 7 )
G(j)表示在分辨率等级为j的情况下,考虑了障碍物和风场区域后,m方向的位置标号取值序列,根据式(8)得到:
H(j)表示在分辨率等级为j情况下,考虑了障碍物和风场区域后,n方向的位置标号取值序列,根据式(9)得到:
其中,式(8)和(9)中的zx,zy分别表示风场中心位置的横、纵坐标;
步骤5:确定各网格单元的飞行环境代价函数值,将环境区域根据障碍物与非障碍物的表示值,以及飞行环境代价函数值生成环境加权图,将多分辨率路径规划问题转化为图的搜索问题;
步骤6:基于A*或Dijkstra搜索方法寻找最优路径,所得到的最优路径就是为飞行器所规划的路径。
2.根据权利要求1所述的一种风场影响下微型无人飞行器的多分辨率路径规划方法,其特征在于,所述的步骤1.3中所述的进行网格划分,能分解的最精细网格为2N×2N,原始数字地形高程图的最高分辨等级Jman决定了能达到的最精细网格,环境区域表示的最高分辨率等级受最精细网格划分的限制,Jman小于等于N。
3.根据权利要求1所述的一种风场影响下微型无人飞行器的多分辨率路径规划方法,其特征在于,所述的步骤2具体实现方法为:
步骤2.1:选取一维空间的Haar基本小波,将Haar基本小波通过伸缩和平移操作得到一组形状相似的小波,得到一维空间的Haar小波基函数:
φ i j ( x ) = 2 j φ ( 2 j x - i ) , ψ i j ( x ) = 2 j ψ ( 2 j x - i ) j = 0,1 , . . . J max andi = 1,2 , . . . , 2 j - 1 - - - ( 10 )
其中,j表示分辨率等级,2j表示伸缩因子,i表示平移量,分别表示伸缩和平移后的Haar尺度函数和Haar母小波函数,x表示一维空间的位置变量;
步骤2.2:由一维空间的Haar小波基函数构造二维空间的Haar小波基函数如下:
Φ m , n j ( x , y ) = φ m j ( x ) φ n j ( y ) Ψ m , n 1 , j ( x , y ) = φ m j ( x ) ψ n j ( y ) ψ m , n 2 , j ( x , y ) = ψ m j ( x ) φ n j ( y ) Ψ m , n 3 , j ( x , y ) = ψ m j ( x ) ψ n j ( y ) - - - ( 11 )
其中,表示二维空间的Haar尺度函数,表示在n方向的Haar母小波函数,表示在m方向的Haar母小波函数,表示在对角线方向的Haar母小波函数;
步骤2.3:将任意一个二元函数用二维空间的Haar小波基函数近似逼近,得到式(2)。
4.根据权利要求1所述的一种风场影响下微型无人飞行器的多分辨率路径规划方法,其特征在于,步骤3中所述的飞行器与障碍物之间的距离因素对飞行环境的影响rm1(X),采用如下公式表示:
其中,Y表示障碍物的位置坐标;
风场的强度对飞行环境的影响rm2(X),采用如下公式表示:
其中,Vmax表示非障碍物空间中的最大风场强度,Vp是非障碍物空间中任意一点p的风场速度,‖VZ表示在Z点处风场的强度;
风场的梯度对飞行环境的影响rm3(X),采用如下公式表示:
其中,表示非障碍物空间中最大的风场梯度, 是非障碍物空间中任意一点p的风场梯度,表示在Z点处风场的梯度。
5.根据权利要求1所述的一种风场影响下微型无人飞行器的多分辨率路径规划方法,其特征在于,步骤5中所述的环境加权图,具体是:环境加权图中的每个节点对应一个网格单元,节点的值表示该处是障碍物还是非障碍物,如果两个网格单元相邻,则用相应的两个节点的边来表示,边上的值表示从一个节点转移到另一个节点的飞行环境代价函数的值。
CN201210046577.7A 2012-02-27 2012-02-27 风场影响下微型无人飞行器的多分辨率路径规划方法 Expired - Fee Related CN102622653B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201210046577.7A CN102622653B (zh) 2012-02-27 2012-02-27 风场影响下微型无人飞行器的多分辨率路径规划方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201210046577.7A CN102622653B (zh) 2012-02-27 2012-02-27 风场影响下微型无人飞行器的多分辨率路径规划方法

Publications (2)

Publication Number Publication Date
CN102622653A CN102622653A (zh) 2012-08-01
CN102622653B true CN102622653B (zh) 2014-10-01

Family

ID=46562560

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201210046577.7A Expired - Fee Related CN102622653B (zh) 2012-02-27 2012-02-27 风场影响下微型无人飞行器的多分辨率路径规划方法

Country Status (1)

Country Link
CN (1) CN102622653B (zh)

Families Citing this family (16)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103592941A (zh) * 2013-10-30 2014-02-19 天津大学 一种飞行速度限制下的无人飞行器航迹规划方法
CN106887162A (zh) * 2015-01-07 2017-06-23 江苏理工学院 一种飞行冲突解脱方法
CN104537263A (zh) * 2015-01-14 2015-04-22 北京航空航天大学 基于小波分析的多分辨率大气数据建模方法
CN104965518B (zh) * 2015-05-21 2017-11-28 华北电力大学 基于三维数字地图的电力巡检飞行机器人航线规划方法
CN105182989B (zh) * 2015-09-25 2018-01-19 北京航空航天大学 一种风场影响下的飞机姿态控制方法
CN106155067A (zh) * 2016-08-17 2016-11-23 张琬彬 依据风力值调整飞行高度的方法及系统
WO2018032420A1 (zh) * 2016-08-17 2018-02-22 张琬彬 依据风力值调整飞行高度的方法及系统
US20180090016A1 (en) * 2016-09-27 2018-03-29 Intel Corporation Methods and apparatus to navigate drones based on weather data
CN106969769A (zh) * 2017-05-03 2017-07-21 南京大学 一种考虑多因素的Dijkstra导航方法
CN107169608B (zh) * 2017-05-27 2020-07-07 合肥工业大学 多无人机执行多任务的分配方法及装置
CN107450576B (zh) * 2017-07-24 2020-06-16 哈尔滨工程大学 一种桥梁检测无人机路径规划的方法
US11030906B2 (en) * 2017-11-16 2021-06-08 The Boeing Company System for taking into account micro wind conditions in flight plans for aerial vehicles
CN108151746B (zh) * 2017-12-27 2020-11-10 中国人民解放军国防科技大学 基于多分辨率态势建图的改进标签实时航路重规划方法
CN113158384B (zh) * 2021-03-03 2021-10-08 东北石油大学 一种油气管道路由规划方法及系统
DE102021106868A1 (de) * 2021-03-19 2022-09-22 Volocopter Gmbh Verfahren zur Planung des Betriebs eines Fluggeräts, Steuereinheit für ein Fluggerät und Fluggerät mit einer solchen
CN114879721B (zh) * 2022-04-22 2023-06-30 南京理工大学 一种复杂受灾环境下无人机全覆盖三维救援路径规划算法

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6317690B1 (en) * 1999-06-28 2001-11-13 Min-Chung Gia Path planning, terrain avoidance and situation awareness system for general aviation
CN101894273A (zh) * 2010-05-26 2010-11-24 北京航空航天大学 一种基于人工蜂群优化边缘势场函数无人机目标识别方法
CN102183955A (zh) * 2011-03-09 2011-09-14 南京航空航天大学 基于多旋翼无人飞行器的输电线路巡检系统

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6317690B1 (en) * 1999-06-28 2001-11-13 Min-Chung Gia Path planning, terrain avoidance and situation awareness system for general aviation
CN101894273A (zh) * 2010-05-26 2010-11-24 北京航空航天大学 一种基于人工蜂群优化边缘势场函数无人机目标识别方法
CN102183955A (zh) * 2011-03-09 2011-09-14 南京航空航天大学 基于多旋翼无人飞行器的输电线路巡检系统

Also Published As

Publication number Publication date
CN102622653A (zh) 2012-08-01

Similar Documents

Publication Publication Date Title
CN102622653B (zh) 风场影响下微型无人飞行器的多分辨率路径规划方法
Simmons et al. Modeling and prediction of internal waves in the South China Sea
CN103557867B (zh) 一种基于稀疏a*搜索的三维多uav协同航迹规划方法
JP6869230B2 (ja) 物体を認識する方法およびシステム
CN103472450B (zh) 基于压缩感知的非均匀空间构形分布式sar动目标三维成像方法
CN103743402B (zh) 一种基于地形信息量的水下智能自适应地形匹配方法
CN105279581A (zh) 基于差分进化的geo-uav双基sar路径规划方法
Du Toit et al. Horseshoes in hurricanes
Mokrane et al. UAV path planning based on dynamic programming algorithm on photogrammetric DEMs
CN104317772A (zh) 一种基于空间网格分割的蒙特卡罗粒子输运快速几何处理方法
CN104318551A (zh) 基于凸包特征检索的高斯混合模型点云配准方法
CN106599053A (zh) 一种三维模型检索方法
CN104778754A (zh) 水下目标动态尾迹与流体微元轨道速度的数值仿真方法
Kijewski-Correa et al. CyberEye: Development of integrated cyber-infrastructure to support rapid hurricane risk assessment
Rohmer et al. A meta-modelling strategy to identify the critical offshore conditions for coastal flooding
CN110097047A (zh) 一种基于深度学习采用单线激光雷达的车辆检测方法
Melet et al. Potential outcomes of glider data assimilation in the Solomon Sea: Control of the water mass properties and parameter estimation
Mu et al. Occupancy grid-based AUV SLAM method with forward-looking sonar
CN105469415A (zh) 多视角遥感图像融合方法
Yao et al. Radar perception in autonomous driving: Exploring different data representations
Lu et al. Data‐Driven Method With Numerical Model: A Combining Framework for Predicting Subtropical River Plumes
Goddard et al. Investigation of ecologically relevant wind patterns on Marion Island using Computational Fluid Dynamics and measured data
Chen Automated Geoscience with Robotics and Machine Learning: A New Hammer of Rock Detection, Mapping, and Dynamics Analysis
Chrit Reconstructing urban wind flows for urban air mobility using reduced-order data assimilation
CN103728617A (zh) 双基地合成孔径雷达时域快速成像方法

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
C14 Grant of patent or utility model
GR01 Patent grant
CF01 Termination of patent right due to non-payment of annual fee

Granted publication date: 20141001

Termination date: 20150227

EXPY Termination of patent right or utility model