CN112729308A - 多约束条件下无人机快速航迹规划方法 - Google Patents

多约束条件下无人机快速航迹规划方法 Download PDF

Info

Publication number
CN112729308A
CN112729308A CN202011551419.8A CN202011551419A CN112729308A CN 112729308 A CN112729308 A CN 112729308A CN 202011551419 A CN202011551419 A CN 202011551419A CN 112729308 A CN112729308 A CN 112729308A
Authority
CN
China
Prior art keywords
correction
error
point
unmanned aerial
aerial vehicle
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.)
Granted
Application number
CN202011551419.8A
Other languages
English (en)
Other versions
CN112729308B (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.)
Guangzhou Rongfu Digital Technology Service Co ltd
Original Assignee
Xian University of Technology
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 Xian University of Technology filed Critical Xian University of Technology
Priority to CN202011551419.8A priority Critical patent/CN112729308B/zh
Publication of CN112729308A publication Critical patent/CN112729308A/zh
Application granted granted Critical
Publication of CN112729308B publication Critical patent/CN112729308B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/20Instruments for performing navigational calculations
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C25/00Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
    • YGENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02TCLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
    • Y02T10/00Road transport of goods or passengers
    • Y02T10/10Internal combustion engine [ICE] based vehicles
    • Y02T10/40Engine management systems

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Manufacturing & Machinery (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

多约束条件下无人机快速航迹规划方法,包括以下步骤:步骤1,将无人机飞行环境中的各校正点简化为无向图中的0‑1模型,简化无人机对校正点的选取;步骤2,进行无人机航迹规划,设置无人机飞行网络的无向结构图,得到各校正点之间的距离;步骤3,根据校正节点的数据处理得到无人机飞行网络图S,无人机在航迹上要求尽可能经过少的飞行误差校正节点,将无人机的航迹规划简化为一个多目标动态规划问题,即选择最优路线和最佳误差点数量和的问题,将航迹规划转化为了0‑1整数规划问题;步骤4,采用改进的Dijkstra算法将设置的目标函数求解,得到的结果就是最优的航迹规划路径;具有简单、快速、动态及智能的特点。

Description

多约束条件下无人机快速航迹规划方法
技术领域
本发明属于无人机应用技术领域,具体涉及多约束条件下无人机快速航迹规划方法,用于复杂环境下无人机的智能航迹快速规划。
背景技术
在复杂环境下,无人机的快速航迹规划是新型智能无人机飞行控制一个很难攻克的课题。由于无人机的结构限制,定位系统无法对其自身进行精准定位,一旦定位误差积累到一定程度可能会导致航迹规划失败。因此,在飞行过程中对定位误差进行校正是智能无人机航迹规划中一项重要任务。
发明内容
为克服上述现有技术的不足,本发明的目的在于提供多约束条件下无人机快速航迹规划方法,通过考虑限制无人机的主要因素和限制无人机飞行的环境因素,通过改进的Dijkstra算法对无人机设计了一个快速航迹规划;具有简单、快速、动态及智能的特点。
为实现上述目的,本发明采用的技术方案是:多约束条件下无人机快速航迹规划方法,其特征在于,包括以下步骤:
步骤1,将无人机飞行环境中的各校正点简化为无向图中的0-1模型,简化无人机对校正点的选取;
步骤2,无人机航迹规划,设置无人机飞行网络的无向结构图,得到各校正点之间的距离;
步骤3,根据校正节点的数据处理得到无人机飞行网络图S,无人机在航迹上要求尽可能经过少的飞行误差校正节点,将无人机的航迹规划简化为一个多目标动态规划问题,即选择最优路线和最佳误差点数量和的问题,将航迹规划转化为了0-1整数规划问题;
步骤4,采用改进的Dijkstra算法将设置的目标函数求解,得到的结果就是最优的航迹规划路径。
所述的步骤1,具体做法是:设智能无人机的出发点为A点,目的地为B点,其航行需要满足如下约束条件:
1)无人机在空间飞行过程中需要实时定位,其定位误差包括垂直误差和水平误差,无人机每飞行1m,垂直误差和水平误差将各增加δ个单位,设定航迹达标条件为到达终点时垂直误差和水平误差均应小于θ个单位,即当垂直误差和水平误差均小于θ个单位时,无人机仍能够按照规划路径飞行;
2)无人机在飞行过程中需要对定位误差进行校正,飞行区域中存在一些校正点可用于误差校正,当无人机到达校正点即可根据该位置的误差校正类型进行误差校正,矫正点的位置可根据地形在航迹规划前确定;可校正的飞行区域分布位置依赖于地形,无统一规律,若垂直误差、水平误差都能得到及时校正,则无人机可以按照预定航线飞行,通过若干个校正点进行误差校正后最终到达目的地。
所述的步骤2,具体做法是:
首先,将无人机飞行区域中的A、B及校正点的坐标进行数据处理,构建无人机飞行邻接距离矩阵,邻接距离矩阵的基本原理是将图中n个顶点的数据存放在一组一维数组中,用一个n×n矩阵的形式来表示各个顶点间的邻接关系,并在邻接距离矩阵中剔除不满足条件的校正节点关系,构建无人机飞行网络图;设置一个无向图D,根据无向图D的各个顶点之间是否可以直接连接,编写一个矩阵,1表示可以直接连接,0表示不能直接连接,定义如下:
A=(aij)n×n称作无向图D的邻接距离矩阵,其中n为校正节点的个数加2,其中:
Figure BDA0002858044710000021
因为任何顶点自身不能相连,所以在任何无向图的邻接矩阵中,主对角线一定为0,其余可以相连的顶点皆为1,由此可得,每个无向图的邻接矩阵皆为关于主对角线对称的n×n的矩阵,邻接矩阵中包含了图的一切性质,邻接矩阵与它所唯一对应的图成一一对应关系;
将无向图转化为无人机飞行网络图,即测量出各个可以相连的校正点之间的距离,将无向图邻接矩阵中的1用实际距离代替,并在邻接距离矩阵中剔除不满足条件的校正节点关系,构建出无人机飞行网络图,其中针对相连的各个顶点之间的距离不满足最大允许调整的水平和垂直误差,用∞表示,即将无向图邻接矩阵中的0用∞代替,得到S=(sij)n×n是无人机的飞行网络图,其中n为校正节点个数加2,2个点分别为起点A和终点B,其中:
Figure BDA0002858044710000031
所述的步骤3,又包括如下步骤:
步骤3.1:先规划从起点A到终点B的最短路径,再找出满足约束条件的最优路径使得无人机在从起点A到终点B飞行过程中需要满足飞行路程最短的同时,尽可能经过少的飞行误差校正节点,
首先对所有校正点进行编号:
1)校正点集:C=[c1,c2,c3…,ci,…cn],i=1,2,3…,n,其中n为校正点个数;
2)水平校正点集:U=[u1,u2,u3…ui…um],i=1,2,3…,m,其中m为水平校正点个数;
3)垂直校正点集:V=[v1,v2,v3…vi…vk],i=1,2,3…,k,其中k为垂直校正点个数;
其中校正点集C、水平校正点集U和垂直校正点集V之间的关系为:U∪V=C,
Figure BDA0002858044710000032
将各校正点分别按照最初的设置加入到水平校正点集U或者垂直校正点集V中;
首先假设无人机从一个校正节点到另一个校正节点之间始终匀速直线运动,忽略转弯引起的轨迹变化,无人机从起点A到终点B的飞行过程中需要依次选择水平校正节点和垂直校正节点进行误差校正,以满足能够在误差允许的范围内到达各个水平或者垂直校正节点进行水平和垂直误差校正,其中需要注意的是无人机到达终点B允许误差和到达各校正节点的允许误差值是不一致的,这是一个多目标航迹规划问题,多目标规划的优化目标是获得在从起点A到终点B的飞行中,航迹路程最小的同时,经过的飞行误差调整点ui orvi,i=1,2,3…,m or k数量最少;
无人机经过水平或者垂直误差校正点的目标函数为:
Figure BDA0002858044710000041
式中,xij表示0-1变量:
Figure BDA0002858044710000042
无人机飞行路程目标函数为:
Figure BDA0002858044710000043
起点or校正点到终点or校正点的路程长度:
Figure BDA0002858044710000044
式中,Xi为i点的横坐标,Yi为i点的纵坐标,Zi为i点的竖坐标;Xj为j点的横坐标,Yj为j点的纵坐标,Zj为j点的竖坐标;
其中无人机的约束条件包括:
1)无人机在空间飞行过程中需要实时定位,其定位误差包括垂直误差和水平误差,无人机每飞行1m,垂直误差和水平误差将各增加δ个单位,则无人机从起点或者校正点ci到终点或者下一个校正点cj的误差增量Pij为:
Figure BDA0002858044710000045
因为任意一个误差校正点ci,i=1,2,3…n在误差允许范围内可调整水平或者垂直误差,则在任意一个校正点ci,i=1,2,3…n的误差P为:
Figure BDA0002858044710000051
其中Pju表示j到下一个校正点的水平增量,Pjv表示j到下一个校正点的垂直增量,Piu表示i到下一个校正点的水平增量,Piv表示i到下一个校正点的垂直增量;xij表示i到j的0-1变量,sij表示i到j的路程长度,δ为垂直误差和水平误差各增加的单位;vj表示第j个垂直校正点,uj表示第j个水平校正点,要求到达终点时垂直误差和水平误差均应小于θ个单位,即:
Piu+xiBsiBδ≤θ且Piv+xiBsiBδ≤θ
其中Piu表示i到下一个校正点的水平增量,xiB表示点i到终点B的0-1变量,siB表示点i到终点B的路程长度,δ为垂直误差和水平误差各增加的单位,θ表示到终点的误差阈值;Piv表示i到下一个校正点的垂直增量;
步骤3.2,设无人机的垂直误差不大于α1个单位,水平误差不大于α2个单位时才能进行垂直误差校正,即:
Piv+xijsijδ≤α1,vj∈V
Piu+xijsijδ≤α2,vj∈V
其中Piv表示i到下一个校正点的垂直增量,xij表示0-1变量,sij表示i到j的路程长度,δ为垂直误差和水平误差各增加的单位,α1为垂直误差的阈值,vj表示第j个垂直校正点;Piu表示i到下一个校正点的水平增量,α2为水平误差的阈值;
当无人机的垂直误差不大于β1个单位,水平误差不大于β2个单位时才能进行水平误差校正,即:
Piv+xijsijδ≤β1,uj∈U
Piu+xijsijδ≤β2,uj∈U
其中Piv表示i到下一个校正点的垂直增量,xij表示0-1变量,sij表示i到j的路程长度,δ为垂直误差和水平误差各增加的单位,β1为垂直误差的阈值,uj表示第j个水平校正点;Piu表示i到下一个校正点的水平增量,β2为水平误差的阈值;
无人机在飞行过程中会根据最优路径和节点数选择经过水平误差补偿和垂直误差补偿点,在实际计算中常常需要直接约束任意两个水平或者垂直误差的阈值,约束条件如下所示:
Figure BDA0002858044710000061
Figure BDA0002858044710000062
其中
Figure BDA0002858044710000063
表示垂直校正点vk-1与vk间的垂直误差,δ为垂直误差和水平误差各增加的单位,α1为垂直误差的阈值;
Figure BDA0002858044710000064
表示水平校正点vk-1与vk间的水平误差,δ为垂直误差和水平误差各增加的单位,β1为垂直误差的阈值,综上所述,无人机飞行航迹的多目标规划为:
无人机经过水平或者垂直误差校正点的目标函数为:
Figure BDA0002858044710000065
无人机飞行路程目标函数为:
Figure BDA0002858044710000066
所述的步骤4,具体做法是:
飞行网络图中有n个顶点,现需要求从校正节点A至校正节点B的最短路径,设S=(sij)n×n为邻接距离矩阵,其分量为:
Figure BDA0002858044710000067
其中,ciorcj为A到B的某一校正点时,sij为实际距离;否则sij取∞,决策变量为xij,当xij=1,说明ci,cj位于起点A至终点B的路上;否则xij=0,其数学规划表达式为:
Figure BDA0002858044710000071
Figure BDA0002858044710000072
xij=0 or 1
采用Dijkstra算法和动态规划方法求解。
所述的Dijkstra算法和动态规划方法求解,具体包括以下步骤:
Step1:对ci≠c0,即无人机从起点出发以后,令
Figure BDA0002858044710000073
其中ci为校正点集中的第i个校正点,c0为起点,其实就是A点,在起点时即i=0时,飞行网络图取0即S0=0,当无人机出发以后,i≠0时,飞行网络图当前点即Si={ci};
Step2:对每个ci∈C,把最小值的定点ci记为yi,令Si+1=Si∪{yi+1};
其中ci为校正点集中的第i个校正点,C为校正点集,yi为暂时存储ci的值,Si+1为第i+1个校正节点的飞行网络图,Si为第i个校正节点的飞行网络图,yi+1存储的是ci+1的值;
Step3:若i=n-1,停止计算;若i<n-1,用i+1替代i,转到Step2;其中n为校正节点的个数加2;
Step4:将得到的路径中的每一个ci,按水平或者垂直校正节点类型分别标记为水平校正点集U=[u1,u2,u3…uk…um],i=1,2,3…,m和垂直校正点集V=[v1,v2,v3…vi…vk],i=1,2,3…,k,其中m和k分别为路径中的水平校正点和垂直校正点个数;
其中ci为校正点集中的第i个校正点,U=[u1,u2,u3…ui…um],i=1,2,3…,m为水平校正点集,V=[v1,v2,v3…vi…vk],i=1,2,3…,k为垂直校正点集;
Step5:对路径中的水平或者垂直误差校正点进行约束优化,约束优化条件如下:
Figure BDA0002858044710000081
Figure BDA0002858044710000082
其中
Figure BDA0002858044710000083
表示垂直校正点vk-1与vk间的垂直误差,δ为垂直误差和水平误差各增加的单位,α1为垂直误差的阈值;
Figure BDA0002858044710000084
表示水平校正点vk-1与vk间的水平误差,δ为垂直误差和水平误差各增加的单位,β1为垂直误差的阈值;
Step6:若满足约束条件,则跳转至Step7,否则跳转至Step2;
Step7:结束。
本发明的有益效果是,
1)通过简化无人机飞行环境中的校正点为0-1模型,将无人机的飞行环境简化为一些可用和不可用的节点集合,简化了飞行环境。
2)将选取最优航迹规划的问题,简化为选择最优路线和最佳误差点数量和的问题,可以简化航迹规划的目标函数,便于求解。
附图说明
图1是无人机的飞行区域;
图2是无人机航迹规划流程图;
图3是改进Dijkstra算法流程图。
具体实施方式
下面结合附图和具体实施方式对本发明进行详细说明。
多约束条件下无人机快速航迹规划方法,其特征在于,包括以下步骤:
步骤1,将无人机飞行环境中的各校正点简化为无向图中的0-1模型,简化无人机对校正点的选取;
步骤2,无人机航迹规划,设置无人机飞行网络的无向结构图,得到各校正点之间的距离;
步骤3,根据校正节点的数据处理得到无人机飞行网络图S,无人机在航迹上要求尽可能经过少的飞行误差校正节点,将无人机的航迹规划简化为一个多目标动态规划问题,即选择最优路线和最佳误差点数量和的问题,将航迹规划转化为了0-1整数规划问题;
步骤4,采用改进的Dijkstra算法将设置的目标函数求解,得到的结果就是最优的航迹规划路径。
所述的步骤1,具体做法是:设智能无人机的出发点为A点,目的地为B点,其航行需要满足如下约束条件:
1)无人机在空间飞行过程中需要实时定位,其定位误差包括垂直误差和水平误差,无人机每飞行1m,垂直误差和水平误差将各增加δ个单位,设定航迹达标条件为到达终点时垂直误差和水平误差均应小于θ个单位,即当垂直误差和水平误差均小于θ个单位时,无人机仍能够按照规划路径飞行;
2)无人机在飞行过程中需要对定位误差进行校正,飞行区域中存在一些校正点可用于误差校正,当无人机到达校正点即可根据该位置的误差校正类型进行误差校正,矫正点的位置可根据地形在航迹规划前确定;可校正的飞行区域分布位置依赖于地形,无统一规律,若垂直误差、水平误差都能得到及时校正,则无人机可以按照预定航线飞行,通过若干个校正点进行误差校正后最终到达目的地。
所述的步骤2,具体做法是:
首先,将无人机飞行区域中的A、B及校正点的坐标进行数据处理,构建无人机飞行邻接距离矩阵,邻接距离矩阵的基本原理是将图中n个顶点的数据存放在一组一维数组中,用一个n×n矩阵的形式来表示各个顶点间的邻接关系,并在邻接距离矩阵中剔除不满足条件的校正节点关系,构建无人机飞行网络图;设置一个无向图D,根据无向图D的各个顶点之间是否可以直接连接,编写一个矩阵,1表示可以直接连接,0表示不能直接连接,定义如下:
A=(aij)n×n称作无向图D的邻接距离矩阵,其中n为校正节点的个数加2,其中:
Figure BDA0002858044710000101
因为任何顶点自身不能相连,所以在任何无向图的邻接矩阵中,主对角线一定为0,其余可以相连的顶点皆为1,由此可得,每个无向图的邻接矩阵皆为关于主对角线对称的n×n的矩阵,邻接矩阵中包含了图的一切性质,邻接矩阵与它所唯一对应的图成一一对应关系;
将无向图转化为无人机飞行网络图,即测量出各个可以相连的校正点之间的距离,将无向图邻接矩阵中的1用实际距离代替,并在邻接距离矩阵中剔除不满足条件的校正节点关系,构建出无人机飞行网络图,其中针对相连的各个顶点之间的距离不满足最大允许调整的水平和垂直误差,用∞表示,即将无向图邻接矩阵中的0用∞代替,得到S=(sij)n×n是无人机的飞行网络图,其中n为校正节点个数加2,2个点分别为起点A和终点B,其中:
Figure BDA0002858044710000102
所述的步骤3,又包括如下步骤:
步骤3.1:先规划从起点A到终点B的最短路径,再找出满足约束条件的最优路径使得无人机在从起点A到终点B飞行过程中需要满足飞行路程最短的同时,尽可能经过少的飞行误差校正节点,
首先对所有校正点进行编号:
1)校正点集:C=[c1,c2,c3…,ci,…cn],i=1,2,3…,n,其中n为校正点个数;
2)水平校正点集:U=[u1,u2,u3…ui…um],i=1,2,3…,m,其中m为水平校正点个数;
3)垂直校正点集:V=[v1,v2,v3…vi…vk],i=1,2,3…,k,其中k为垂直校正点个数;
其中校正点集C、水平校正点集U和垂直校正点集V之间的关系为:U∪V=C,
Figure BDA0002858044710000111
将各校正点分别按照最初的设置加入到水平校正点集U或者垂直校正点集V中;
首先假设无人机从一个校正节点到另一个校正节点之间始终匀速直线运动,忽略转弯引起的轨迹变化,无人机从起点A到终点B的飞行过程中需要依次选择水平校正节点和垂直校正节点进行误差校正,以满足能够在误差允许的范围内到达各个水平或者垂直校正节点进行水平和垂直误差校正,其中需要注意的是无人机到达终点B允许误差和到达各校正节点的允许误差值是不一致的,这是一个多目标航迹规划问题,多目标规划的优化目标是获得在从起点A到终点B的飞行中,航迹路程最小的同时,经过的飞行误差调整点ui orvi,i=1,2,3…,m or k数量最少;
无人机经过水平或者垂直误差校正点的目标函数为:
Figure BDA0002858044710000112
式中,xij表示0-1变量:
Figure BDA0002858044710000113
无人机飞行路程目标函数为:
Figure BDA0002858044710000114
起点or校正点到终点or校正点的路程长度:
Figure BDA0002858044710000115
式中,Xi为i点的横坐标,Yi为i点的纵坐标,Zi为i点的竖坐标;Xj为j点的横坐标,Yj为j点的纵坐标,Zj为j点的竖坐标;
其中无人机的约束条件包括:
1)无人机在空间飞行过程中需要实时定位,其定位误差包括垂直误差和水平误差,无人机每飞行1m,垂直误差和水平误差将各增加δ个单位,则无人机从起点或者校正点ci到终点或者下一个校正点cj的误差增量Pij为:
Figure BDA0002858044710000121
因为任意一个误差校正点ci,i=1,2,3…n在误差允许范围内可调整水平或者垂直误差,则在任意一个校正点ci,i=1,2,3…n的误差P为:
Figure BDA0002858044710000122
其中Pju表示j到下一个校正点的水平增量,Pjv表示j到下一个校正点的垂直增量,Piu表示i到下一个校正点的水平增量,Piv表示i到下一个校正点的垂直增量;xij表示i到j的0-1变量,sij表示i到j的路程长度,δ为垂直误差和水平误差各增加的单位;vj表示第j个垂直校正点,uj表示第j个水平校正点,要求到达终点时垂直误差和水平误差均应小于θ个单位,即:
Piu+xiBsiBδ≤θ且Piv+xiBsiBδ≤θ
其中Piu表示i到下一个校正点的水平增量,xiB表示点i到终点B的0-1变量,siB表示点i到终点B的路程长度,δ为垂直误差和水平误差各增加的单位,θ表示到终点的误差阈值;Piv表示i到下一个校正点的垂直增量;
步骤3.2,设无人机的垂直误差不大于α1个单位,水平误差不大于α2个单位时才能进行垂直误差校正,即:
Piv+xijsijδ≤α1,vj∈V
Piu+xijsijδ≤α2,vj∈V
其中Piv表示i到下一个校正点的垂直增量,xij表示0-1变量,sij表示i到j的路程长度,δ为垂直误差和水平误差各增加的单位,α1为垂直误差的阈值,vj表示第j个垂直校正点;Piu表示i到下一个校正点的水平增量,α2为水平误差的阈值;
当无人机的垂直误差不大于β1个单位,水平误差不大于β2个单位时才能进行水平误差校正,即:
Piv+xijsijδ≤β1,uj∈U
Piu+xijsijδ≤β2,uj∈U
其中Piv表示i到下一个校正点的垂直增量,xij表示0-1变量,sij表示i到j的路程长度,δ为垂直误差和水平误差各增加的单位,β1为垂直误差的阈值,uj表示第j个水平校正点;Piu表示i到下一个校正点的水平增量,β2为水平误差的阈值,
无人机在飞行过程中会根据最优路径和节点数选择经过水平误差补偿和垂直误差补偿点,在实际计算中常常需要直接约束任意两个水平或者垂直误差的阈值,约束条件如下所示:
Figure BDA0002858044710000131
Figure BDA0002858044710000132
其中
Figure BDA0002858044710000133
表示垂直校正点vk-1与vk间的垂直误差,δ为垂直误差和水平误差各增加的单位,α1为垂直误差的阈值;
Figure BDA0002858044710000134
表示水平校正点vk-1与vk间的水平误差,δ为垂直误差和水平误差各增加的单位,β1为垂直误差的阈值,综上所述,无人机飞行航迹的多目标规划为:
无人机经过水平或者垂直误差校正点的目标函数为:
Figure BDA0002858044710000135
无人机飞行路程目标函数为:
Figure BDA0002858044710000141
所述的步骤4,具体做法是:
飞行网络图中有n个顶点,现需要求从校正节点A至校正节点B的最短路径,设S=(sij)n×n为邻接距离矩阵,其分量为:
Figure BDA0002858044710000142
其中,ciorcj为A到B的某一校正点时,sij为实际距离;否则sij取∞,决策变量为xij,当xij=1,说明ci,cj位于起点A至终点B的路上;否则xij=0,其数学规划表达式为:
Figure BDA0002858044710000143
Figure BDA0002858044710000144
xij=0 or 1
采用Dijkstra算法和动态规划方法求解。
所述的Dijkstra算法和动态规划方法求解,具体包括以下步骤:
Step1:对ci≠c0,即无人机从起点出发以后,令
Figure BDA0002858044710000145
其中ci为校正点集中的第i个校正点,c0为起点,其实就是A点,在起点时即i=0时,飞行网络图取0即S0=0,当无人机出发以后,i≠0时,飞行网络图当前点即Si={ci};
Step2:对每个ci∈C,把最小值的定点ci记为yi,令Si+1=Si∪{yi+1};
其中ci为校正点集中的第i个校正点,C为校正点集,yi为暂时存储ci的值,Si+1为第i+1个校正节点的飞行网络图,Si为第i个校正节点的飞行网络图,yi+1存储的是ci+1的值;
Step3:若i=n-1,停止计算;若i<n-1,用i+1替代i,转到Step2;其中n为校正节点的个数加2;
Step4:将得到的路径中的每一个ci,按水平或者垂直校正节点类型分别标记为水平校正点集U=[u1,u2,u3…uk…um],i=1,2,3…,m和垂直校正点集V=[v1,v2,v3…vi…vk],i=1,2,3…,k,其中m和k分别为路径中的水平校正点和垂直校正点个数;
其中ci为校正点集中的第i个校正点,U=[u1,u2,u3…ui…um],i=1,2,3…,m为水平校正点集,V=[v1,v2,v3…vi…vk],i=1,2,3…,k为垂直校正点集;
Step5:对路径中的水平或者垂直误差校正点进行约束优化,约束优化条件如下:
Figure BDA0002858044710000151
Figure BDA0002858044710000152
其中
Figure BDA0002858044710000153
表示垂直校正点vk-1与vk间的垂直误差,δ为垂直误差和水平误差各增加的单位,α1为垂直误差的阈值;
Figure BDA0002858044710000154
表示水平校正点vk-1与vk间的水平误差,δ为垂直误差和水平误差各增加的单位,β1为垂直误差的阈值;
Step6:若满足约束条件,则跳转至Step7,否则跳转至Step2;
Step7:结束。
在复杂环境下,考虑无人机在自身条件的约束下对其飞行路径进行规划。首先将无人机飞行的飞行环境中的各校正点简化为无向图中的0-1模型,这样可以简化无人机对校正点的选取;然后将选取最优航迹规划的问题简化为选择最优路线和最佳误差点数量和的问题,可以将航迹规划的目标函数简化;最后采用改进的Dijkstra算法将设置的目标函数求解,得到的结果就是最优的航迹规划路径。
多约束条件下无人机快速航迹规划方法,包括以下步骤:
步骤1,设智能无人机的出发点为A点,目的地为B点。其航行需要满足如下约束条件:
1)无人机在空间飞行过程中需要实时定位,其定位误差包括垂直误差和水平误差。无人机每飞行1m,垂直误差和水平误差将各增加δ个单位,设定航迹达标条件为到达终点时垂直误差和水平误差均应小于θ个单位,即当垂直误差和水平误差均小于θ个单位时,无人机仍能够按照规划路径飞行。
2)无人机在飞行过程中需要对定位误差进行校正。飞行区域中存在一些校正点可用于误差校正,当无人机到达校正点即可根据该位置的误差校正类型进行误差校正。矫正点的位置可根据地形在航迹规划前确定(如图1中黄色的点为水平误差校正点,蓝色的点为垂直误差校正点,黑色曲线代表规划的一条航迹)。可校正的飞行区域分布位置依赖于地形,无统一规律。若垂直误差、水平误差都能得到及时校正,则无人机可以按照预定航线飞行,通过若干个校正点进行误差校正后最终到达目的地。
步骤2,图2为无人机航迹规划流程图。首先将无人机飞行区域中的A、B及校正点的坐标进行数据处理,构建无人机飞行邻接距离矩阵。邻接距离矩阵的基本原理是将图中n个顶点的数据存放在一组一维数组中,用一个n×n矩阵的形式来表示各个顶点间的邻接关系。并在邻接距离矩阵中剔除不满足条件的校正节点关系,从而构建无人机飞行网络图。设置一个无向图D,根据D的各个顶点之间是否可以直接连接,编写一个矩阵,1表示可以直接连接,0表示不能直接连接,定义如下:
A=(aij)n×n称作无向图D的邻接距离矩阵,其中n为校正节点的个数加2,其中
Figure BDA0002858044710000171
因为任何顶点自身不能相连,所以在任何无向图的邻接矩阵中,主对角线一定为0,其余可以相连的顶点皆为1。由此可得,每个无向图的邻接矩阵皆为关于主对角线对称的n×n的矩阵。邻接矩阵中包含了图的一切性质,邻接矩阵与它所唯一对应的图成一一对应关系。
将无向图转化为无人机飞行网络图,即测量出各个可以相连的校正点之间的距离,将无向图邻接矩阵中的“1”用实际距离代替,并在邻接距离矩阵中剔除不满足条件的校正节点关系,构建出无人机飞行网络图。其中针对相连的各个顶点之间的距离不满足最大允许调整的水平和垂直误差,用“∞”表示,即将无向图邻接矩阵中的“0”用“∞”代替。得到S=(sij)n×n是无人机的飞行网络图,其中n为校正节点个数加2,2个点分别为起点A和终点B,其中:
Figure BDA0002858044710000172
步骤3:根据校正节点的数据处理得到无人机飞行网络图S,无人机在航迹上要求尽可能经过少的飞行误差校正节点,将无人机的航迹规划简化为一个多目标动态规划问题,即选择最优路线和最佳误差点数量和的问题,无人机在飞行过程中经过校正节点ci到校正节点cj,则选中无人机飞行网络图中的边sij,加入最优飞行路径中,否则sij取零,因此将航迹规划转化为了0-1整数规划问题;
步骤3.1:先规划从起点A到终点B的最短路径,再找出满足约束条件的最优路径使得无人机在从起点A到终点B飞行过程中需要满足飞行路程最短的同时,尽可能经过少的飞行误差校正节点。
首先对所有校正点进行编号:
1)校正点集:C=[c1,c2,c3…,ci,…cn],i=1,2,3…,n,其中n为校正点个数;
2)水平校正点集:U=[u1,u2,u3…ui…um],i=1,2,3…,m,其中m为水平校正点个数;
3)垂直校正点集:V=[v1,v2,v3…vi…vk],i=1,2,3…,k,其中k为垂直校正点个数;
其中校正点集C、水平校正点集U和垂直校正点集V之间的关系为U∪V=C,
Figure BDA0002858044710000185
将各校正点分别按照最初的设置加入到水平校正点集U或者垂直校正点集V中;
首先假设无人机从一个校正节点到另一个校正节点之间始终匀速直线运动,忽略转弯引起的轨迹变化。无人机从起点A到终点B的飞行过程中需要依次选择水平校正节点和垂直校正节点进行误差校正,以满足能够在误差允许的范围内到达各个水平或者垂直校正节点进行水平和垂直误差校正;其中需要注意的是无人机到达终点B允许误差和到达各校正节点的允许误差值是不一致的,这是一个多目标航迹规划问题。多目标规划的优化目标是获得在从起点A到终点B的飞行中,航迹路程最小的同时,经过的飞行误差调整点ui orvi,i=1,2,3…,m or Q数量最少;
无人机飞行路程目标函数为:
Figure BDA0002858044710000181
无人机经过水平或者垂直误差校正点的目标函数为:
Figure BDA0002858044710000182
式中,0-1变量:
Figure BDA0002858044710000183
起点or校正点到终点or校正点的路程长度:
Figure BDA0002858044710000184
其中无人机的约束条件包括:
1)无人机在空间飞行过程中需要实时定位,其定位误差包括垂直误差和水平误差。无人机每飞行1m,垂直误差和水平误差将各增加δ个单位,则无人机从起点或者校正点ci到终点或者下一个校正点cj的误差增量P为:
Figure BDA0002858044710000191
式中(a,b)为1×2维矩阵,因为任意一个误差校正点ci,i=1,2,3…n在误差允许范围内可调整水平或者垂直误差。则在任意一个校正点ci,i=1,2,3…n的剩余误差为:
Figure BDA0002858044710000192
其中Pju表示校正点ci,i=1,2,3…n的水平剩余误差;Pjv表示垂直剩余误差。要求到达终点时垂直误差和水平误差均应小于个单位,即:
Piu+xiBsiBδ≤θ且Piv+xiBsiBδ≤θ
步骤3.2:设无人机的垂直误差不大于α1个单位,水平误差不大于α2个单位时才能进行垂直误差校正,即:
Piv+xijsijδ≤α1,vj∈V
Piu+xijsijδ≤α2,vj∈V
当无人机的垂直误差不大于β1个单位,水平误差不大于β2个单位时才能进行水平误差校正,即:
Piv+xijsijδ≤β1,uj∈U
Piu+xijsijδ≤β2,uj∈U
无人机在飞行过程中会根据最优路径和节点数选择经过水平误差补偿和垂直误差补偿点,在实际计算中常常需要直接约束任意两个水平或者垂直误差的阈值,约束条件如下所示:
Figure BDA0002858044710000193
Figure BDA0002858044710000194
其中
Figure BDA0002858044710000201
表示垂直校正点vk-1与vk间的垂直误差,δ为垂直误差和水平误差各增加的单位,α1为垂直误差的阈值;
Figure BDA0002858044710000202
表示水平校正点vk-1与vk间的水平误差,δ为垂直误差和水平误差各增加的单位,β1为垂直误差的阈值。
综上所述,无人机飞行航迹的多目标规划为:
无人机经过水平或者垂直误差校正点的目标函数为:
Figure BDA0002858044710000203
无人机飞行路程目标函数为:
Figure BDA0002858044710000204
步骤4:通过改进Dijkstra算法和动态规划方法对上述模型求解。图3为改进Dijkstra算法流程图。
飞行网络图中有n个顶点,现需要求从校正节点A至校正节点B的最短路径。设S=(sij)n×n为邻接距离矩阵,其分量为:
Figure BDA0002858044710000205
当xij=1时,说明ci,cj位于校正节点A至校正节点B的路上;否则xij=0。
采用Dijkstra算法和动态规划方法求解,具体步骤如下:
Step1:对ci≠c0,即无人机从起点出发以后,令
Figure BDA0002858044710000206
其中ci为校正点集中的第i个校正点,c0为起点,其实就是A点,在起点时即i=0时,飞行网络图取0即S0=0,当无人机出发以后,i≠0时,飞行网络图当前点即Si={ci};
Step2:对每个ci∈C,把最小值的定点ci记为yi,令Si+1=Si∪{yi+1};
其中ci为校正点集中的第i个校正点,C为校正点集,yi为暂时存储ci的值,Si+1为第i+1个校正节点的飞行网络图,Si为第i个校正节点的飞行网络图,yi+1存储的是ci+1的值;
Step3:若i=n-1,停止计算;若i<n-1,用i+1替代i,转到Step2;其中n为校正节点的个数加2;
Step4:将得到的路径中的每一个ci,按水平或者垂直校正节点类型分别标记为水平校正点集U=[u1,u2,u3…uk…um],i=1,2,3…,m和垂直校正点集V=[v1,v2,v3…vi…vk],i=1,2,3…,k,其中m和k分别为路径中的水平校正点和垂直校正点个数;
其中ci为校正点集中的第i个校正点,U=[u1,u2,u3…ui…um],i=1,2,3…,m为水平校正点集,V=[v1,v2,v3…vi…vk],i=1,2,3…,k为垂直校正点集;
Step5:对路径中的水平或者垂直误差校正点进行约束优化,约束优化条件如下:
Figure BDA0002858044710000211
Figure BDA0002858044710000212
其中
Figure BDA0002858044710000213
表示垂直校正点vk-1与vk间的垂直误差,δ为垂直误差和水平误差各增加的单位,α1为垂直误差的阈值;
Figure BDA0002858044710000214
表示水平校正点vk-1与vk间的水平误差,δ为垂直误差和水平误差各增加的单位,β1为垂直误差的阈值;
Step6:若满足约束条件,则跳转至Step7,否则跳转至Step2。
Step7:结束。

Claims (6)

1.多约束条件下无人机快速航迹规划方法,其特征在于,包括以下步骤:
步骤1,将无人机飞行环境中的各校正点简化为无向图中的0-1模型,简化无人机对校正点的选取;
步骤2,无人机航迹规划,设置无人机飞行网络的无向结构图,得到各校正点之间的距离;
步骤3,根据校正节点的数据处理得到无人机飞行网络图S,无人机在航迹上要求尽可能经过少的飞行误差校正节点,将无人机的航迹规划简化为一个多目标动态规划问题,即选择最优路线和最佳误差点数量和的问题,将航迹规划转化为了0-1整数规划问题;
步骤4,采用改进的Dijkstra算法将设置的目标函数求解,得到的结果就是最优的航迹规划路径。
2.根据权利要求1所述的多约束条件下无人机快速航迹规划方法,其特征在于,所述的步骤1,具体做法是:设智能无人机的出发点为A点,目的地为B点,其航行需要满足如下约束条件:
1)无人机在空间飞行过程中需要实时定位,其定位误差包括垂直误差和水平误差,无人机每飞行1m,垂直误差和水平误差将各增加δ个单位,设定航迹达标条件为到达终点时垂直误差和水平误差均应小于θ个单位,即当垂直误差和水平误差均小于θ个单位时,无人机仍能够按照规划路径飞行;
2)无人机在飞行过程中需要对定位误差进行校正,飞行区域中存在一些校正点可用于误差校正,当无人机到达校正点即可根据该位置的误差校正类型进行误差校正,矫正点的位置可根据地形在航迹规划前确定;可校正的飞行区域分布位置依赖于地形,无统一规律,若垂直误差、水平误差都能得到及时校正,则无人机可以按照预定航线飞行,通过若干个校正点进行误差校正后最终到达目的地。
3.根据权利要求1所述的多约束条件下无人机快速航迹规划方法,其特征在于,所述的步骤2,具体做法是:
首先,将无人机飞行区域中的A、B及校正点的坐标进行数据处理,构建无人机飞行邻接距离矩阵,邻接距离矩阵的基本原理是将图中n个顶点的数据存放在一组一维数组中,用一个n×n矩阵的形式来表示各个顶点间的邻接关系,并在邻接距离矩阵中剔除不满足条件的校正节点关系,构建无人机飞行网络图;设置一个无向图D,根据无向图D的各个顶点之间是否可以直接连接,编写一个矩阵,1表示可以直接连接,0表示不能直接连接,定义如下:
A=(aij)n×n称作无向图D的邻接距离矩阵,其中n为校正节点的个数加2,其中:
Figure FDA0002858044700000021
因为任何顶点自身不能相连,所以在任何无向图的邻接矩阵中,主对角线一定为0,其余可以相连的顶点皆为1,由此可得,每个无向图的邻接矩阵皆为关于主对角线对称的n×n的矩阵,邻接矩阵中包含了图的一切性质,邻接矩阵与它所唯一对应的图成一一对应关系;
将无向图转化为无人机飞行网络图,即测量出各个可以相连的校正点之间的距离,将无向图邻接矩阵中的1用实际距离代替,并在邻接距离矩阵中剔除不满足条件的校正节点关系,构建出无人机飞行网络图,其中针对相连的各个顶点之间的距离不满足最大允许调整的水平和垂直误差,用∞表示,即将无向图邻接矩阵中的0用∞代替,得到S=(sij)n×n是无人机的飞行网络图,其中n为校正节点个数加2,2个点分别为起点A和终点B,其中:
Figure FDA0002858044700000022
4.根据权利要求1所述的多约束条件下无人机快速航迹规划方法,其特征在于,所述的步骤3,又包括如下步骤:
步骤3.1:先规划从起点A到终点B的最短路径,再找出满足约束条件的最优路径使得无人机在从起点A到终点B飞行过程中需要满足飞行路程最短的同时,尽可能经过少的飞行误差校正节点,
首先对所有校正点进行编号:
1)校正点集:C=[c1,c2,c3…,ci,…cn],i=1,2,3…,n,其中n为校正点个数;
2)水平校正点集:U=[u1,u2,u3…ui…um],i=1,2,3…,m,其中m为水平校正点个数;
3)垂直校正点集:V=[v1,v2,v3…vi…vk],i=1,2,3…,k,其中k为垂直校正点个数;
其中校正点集C、水平校正点集U和垂直校正点集V之间的关系为:U∪V=C,
Figure FDA0002858044700000031
将各校正点分别按照最初的设置加入到水平校正点集U或者垂直校正点集V中;
首先假设无人机从一个校正节点到另一个校正节点之间始终匀速直线运动,忽略转弯引起的轨迹变化,无人机从起点A到终点B的飞行过程中需要依次选择水平校正节点和垂直校正节点进行误差校正,以满足能够在误差允许的范围内到达各个水平或者垂直校正节点进行水平和垂直误差校正,其中需要注意的是无人机到达终点B允许误差和到达各校正节点的允许误差值是不一致的,这是一个多目标航迹规划问题,多目标规划的优化目标是获得在从起点A到终点B的飞行中,航迹路程最小的同时,经过的飞行误差调整点ui or vi,i=1,2,3…,m or k数量最少;
无人机经过水平或者垂直误差校正点的目标函数为:
Figure FDA0002858044700000032
式中,xij表示0-1变量:
Figure FDA0002858044700000041
无人机飞行路程目标函数为:
Figure FDA0002858044700000042
起点or校正点到终点or校正点的路程长度:
Figure FDA0002858044700000043
式中,Xi为i点的横坐标,Yi为i点的纵坐标,Zi为i点的竖坐标;Xj为j点的横坐标,Yj为j点的纵坐标,Zj为j点的竖坐标;
其中无人机的约束条件包括:
1)无人机在空间飞行过程中需要实时定位,其定位误差包括垂直误差和水平误差,无人机每飞行1m,垂直误差和水平误差将各增加δ个单位,则无人机从起点或者校正点ci到终点或者下一个校正点cj的误差增量Pij为:
Figure FDA0002858044700000044
因为任意一个误差校正点ci,i=1,2,3…n在误差允许范围内可调整水平或者垂直误差,则在任意一个校正点ci,i=1,2,3…n的误差P为:
Figure FDA0002858044700000045
其中Pju表示j到下一个校正点的水平增量,Pjv表示j到下一个校正点的垂直增量,Piu表示i到下一个校正点的水平增量,Piv表示i到下一个校正点的垂直增量;xij表示i到j的0-1变量,sij表示i到j的路程长度,δ为垂直误差和水平误差各增加的单位;vj表示第j个垂直校正点,uj表示第j个水平校正点,要求到达终点时垂直误差和水平误差均应小于θ个单位,即:
Piu+xiBsiBδ≤θ且Piv+xiBsiBδ≤θ
其中Piu表示i到下一个校正点的水平增量,xiB表示点i到终点B的0-1变量,siB表示点i到终点B的路程长度,δ为垂直误差和水平误差各增加的单位,θ表示到终点的误差阈值;Piv表示i到下一个校正点的垂直增量;
步骤3.2,设无人机的垂直误差不大于α1个单位,水平误差不大于α2个单位时才能进行垂直误差校正,即:
Piv+xijsijδ≤α1,vj∈V
Piu+xijsijδ≤α2,vj∈V
其中Piv表示i到下一个校正点的垂直增量,xij表示0-1变量,sij表示i到j的路程长度,δ为垂直误差和水平误差各增加的单位,α1为垂直误差的阈值,vj表示第j个垂直校正点;Piu表示i到下一个校正点的水平增量,α2为水平误差的阈值;
当无人机的垂直误差不大于β1个单位,水平误差不大于β2个单位时才能进行水平误差校正,即:
Piv+xijsijδ≤β1,uj∈U
Piu+xijsijδ≤β2,uj∈U
其中Piv表示i到下一个校正点的垂直增量,xij表示0-1变量,sij表示i到j的路程长度,δ为垂直误差和水平误差各增加的单位,β1为垂直误差的阈值,uj表示第j个水平校正点;Piu表示i到下一个校正点的水平增量,β2为水平误差的阈值。
无人机在飞行过程中会根据最优路径和节点数选择经过水平误差补偿和垂直误差补偿点,在实际计算中常常需要直接约束任意两个水平或者垂直误差的阈值,约束条件如下所示:
Figure FDA0002858044700000061
Figure FDA0002858044700000062
其中
Figure FDA0002858044700000063
表示垂直校正点vk-1与vk间的垂直误差,δ为垂直误差和水平误差各增加的单位,α1为垂直误差的阈值;
Figure FDA0002858044700000064
表示水平校正点vk-1与vk间的水平误差,δ为垂直误差和水平误差各增加的单位,β1为垂直误差的阈值。
综上所述,无人机飞行航迹的多目标规划为:
无人机经过水平或者垂直误差校正点的目标函数为:
Figure FDA0002858044700000065
无人机飞行路程目标函数为:
Figure FDA0002858044700000066
5.根据权利要求1所述的多约束条件下无人机快速航迹规划方法,其特征在于,所述的步骤4,具体做法是:
飞行网络图中有n个顶点,现需要求从校正节点A至校正节点B的最短路径,设S=(sij)n×n为邻接距离矩阵,其分量为:
Figure FDA0002858044700000067
其中,ciorcj为A到B的某一校正点时,sij为实际距离;否则sij取∞,决策变量为xij,当xij=1,说明ci,cj位于起点A至终点B的路上;否则xij=0,其数学规划表达式为:
Figure FDA0002858044700000068
Figure FDA0002858044700000069
xij=0 or 1
采用Dijkstra算法和动态规划方法求解。
6.根据权利要求5所述的多约束条件下无人机快速航迹规划方法,其特征在于,所述的Dijkstra算法和动态规划方法求解,具体包括以下步骤:
Step1:对ci≠c0,即无人机从起点出发以后,令
Figure FDA0002858044700000071
其中ci为校正点集中的第i个校正点,c0为起点,其实就是A点,在起点时即i=0时,飞行网络图取0即S0=0,当无人机出发以后,i≠0时,飞行网络图当前点即Si={ci};
Step2:对每个ci∈C,把最小值的定点ci记为yi,令;
其中ci为校正点集中的第i个校正点,C为校正点集,yi为暂时存储ci的值,Si+1为第i+1个校正节点的飞行网络图,Si为第i个校正节点的飞行网络图,yi+1存储的是ci+1的值;
Step3:若i=n-1,停止计算;若i<n-1,用i+1替代i,转到Step2;
其中n为校正节点的个数加2;
Step4:将得到的路径中的每一个ci,按水平或者垂直校正节点类型分别标记为水平校正点集U=[u1,u2,u3…uk…um],i=1,2,3…,m和垂直校正点集V=[v1,v2,v3…vi…vk],i=1,2,3…,k,其中m和k分别为路径中的水平校正点和垂直校正点个数;
其中ci为校正点集中的第i个校正点,U=[u1,u2,u3…ui…um],i=1,2,3…,m为水平校正点集,V=[v1,v2,v3…vi…vk],i=1,2,3…,k为垂直校正点集;
Step5:对路径中的水平或者垂直误差校正点进行约束优化,约束优化条件如下:
Figure FDA0002858044700000072
Figure FDA0002858044700000073
其中
Figure FDA0002858044700000081
表示垂直校正点vk-1与vk间的垂直误差,δ为垂直误差和水平误差各增加的单位,α1为垂直误差的阈值;
Figure FDA0002858044700000082
表示水平校正点vk-1与vk间的水平误差,δ为垂直误差和水平误差各增加的单位,β1为垂直误差的阈值;
Step6:若满足约束条件,则跳转至Step7,否则跳转至Step2;
Step7:结束。
CN202011551419.8A 2020-12-24 2020-12-24 多约束条件下无人机快速航迹规划方法 Active CN112729308B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202011551419.8A CN112729308B (zh) 2020-12-24 2020-12-24 多约束条件下无人机快速航迹规划方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202011551419.8A CN112729308B (zh) 2020-12-24 2020-12-24 多约束条件下无人机快速航迹规划方法

Publications (2)

Publication Number Publication Date
CN112729308A true CN112729308A (zh) 2021-04-30
CN112729308B CN112729308B (zh) 2024-05-03

Family

ID=75615298

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202011551419.8A Active CN112729308B (zh) 2020-12-24 2020-12-24 多约束条件下无人机快速航迹规划方法

Country Status (1)

Country Link
CN (1) CN112729308B (zh)

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113311869A (zh) * 2021-05-28 2021-08-27 淮阴工学院 一种多约束条件下无人机路径规划方法
CN114460969A (zh) * 2022-02-16 2022-05-10 中银金融科技有限公司 无人机路径规划方法、装置、电子设备及计算机存储介质
CN114545974A (zh) * 2022-03-02 2022-05-27 广东翼景信息科技有限公司 一种基于智能机场的有能力约束无人机弧路径规划方法

Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20100094485A1 (en) * 2008-10-10 2010-04-15 Eads Deutschland Gmbh Computation-Time-Optimized Route Planning for Aircraft
CN108151746A (zh) * 2017-12-27 2018-06-12 中国人民解放军国防科技大学 基于多分辨率态势建图的改进标签实时航路重规划方法
EP3349088A1 (en) * 2017-01-13 2018-07-18 Tata Consultancy Services Limited Systems and method for turn angle constrained aerial path planning
US20180308371A1 (en) * 2017-04-19 2018-10-25 Beihang University Joint search method for uav multiobjective path planning in urban low altitude environment
CN108981715A (zh) * 2018-08-22 2018-12-11 北航(四川)西部国际创新港科技有限公司 一种山区飞行安全度约束的无人机路径规划方法
CN110715664A (zh) * 2019-11-05 2020-01-21 大连理工大学 多约束条件下智能无人飞行器航迹快速规划方法
CN111024092A (zh) * 2019-12-31 2020-04-17 西南交通大学 一种多约束条件下智能飞行器航迹快速规划方法
CN111207752A (zh) * 2020-01-17 2020-05-29 西北工业大学 一种基于动态切点调整的无人机航迹规划方法
CN111595343A (zh) * 2020-04-29 2020-08-28 西北工业大学 一种基于定位误差校正的无人机航迹规划方法

Patent Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20100094485A1 (en) * 2008-10-10 2010-04-15 Eads Deutschland Gmbh Computation-Time-Optimized Route Planning for Aircraft
EP3349088A1 (en) * 2017-01-13 2018-07-18 Tata Consultancy Services Limited Systems and method for turn angle constrained aerial path planning
US20180308371A1 (en) * 2017-04-19 2018-10-25 Beihang University Joint search method for uav multiobjective path planning in urban low altitude environment
CN108151746A (zh) * 2017-12-27 2018-06-12 中国人民解放军国防科技大学 基于多分辨率态势建图的改进标签实时航路重规划方法
CN108981715A (zh) * 2018-08-22 2018-12-11 北航(四川)西部国际创新港科技有限公司 一种山区飞行安全度约束的无人机路径规划方法
CN110715664A (zh) * 2019-11-05 2020-01-21 大连理工大学 多约束条件下智能无人飞行器航迹快速规划方法
CN111024092A (zh) * 2019-12-31 2020-04-17 西南交通大学 一种多约束条件下智能飞行器航迹快速规划方法
CN111207752A (zh) * 2020-01-17 2020-05-29 西北工业大学 一种基于动态切点调整的无人机航迹规划方法
CN111595343A (zh) * 2020-04-29 2020-08-28 西北工业大学 一种基于定位误差校正的无人机航迹规划方法

Non-Patent Citations (5)

* Cited by examiner, † Cited by third party
Title
XUELI WU ETAL.: "Bi-directional adaptive A* algorithm toward optimal path planning for largescale UAV under multi-constraints", IEEEACCESS, vol. 8 *
刘畅;谢文俊;张鹏;郭庆;高超;: "多重威胁下的无人机自主避障航迹规划", 哈尔滨工业大学学报, no. 04, 30 April 2020 (2020-04-30) *
吴玉文;牛智越;韩倩倩;: "基于启发式搜索算法的无人机航迹快速规划", 科学技术与工程, no. 20 *
秦子柔;: "基于多标号修正法的快速最短路算法在智能飞行器航迹快速规划问题中的应用", 科学技术创新, no. 25, 5 August 2020 (2020-08-05) *
肖宇: "无人飞行器航迹规划的研究", 中国优秀硕士论文全文数据库工程科技辑, no. 1 *

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113311869A (zh) * 2021-05-28 2021-08-27 淮阴工学院 一种多约束条件下无人机路径规划方法
CN114460969A (zh) * 2022-02-16 2022-05-10 中银金融科技有限公司 无人机路径规划方法、装置、电子设备及计算机存储介质
CN114545974A (zh) * 2022-03-02 2022-05-27 广东翼景信息科技有限公司 一种基于智能机场的有能力约束无人机弧路径规划方法
CN114545974B (zh) * 2022-03-02 2023-12-19 广东翼景信息科技有限公司 一种基于智能机场的有能力约束无人机弧路径规划方法

Also Published As

Publication number Publication date
CN112729308B (zh) 2024-05-03

Similar Documents

Publication Publication Date Title
CN112729308A (zh) 多约束条件下无人机快速航迹规划方法
CN111024092B (zh) 一种多约束条件下智能飞行器航迹快速规划方法
CN111352417B (zh) 异构多无人机协同路径的快速生成方法
CN111595343B (zh) 一种基于定位误差校正的无人机航迹规划方法
CN110715664B (zh) 多约束条件下智能无人飞行器航迹快速规划方法
CN111006693B (zh) 智能飞行器航迹规划系统及其方法
CN111707273B (zh) 一种基于遗传算法的飞行器航迹快速规划优化方法
CN111207752B (zh) 一种基于动态切点调整的无人机航迹规划方法
CN111220159A (zh) 多无人机协同巡检任务的路径优化方法
CN109062040B (zh) 基于系统嵌套优化的预测pid方法
CN110794874B (zh) 一种定位误差约束下的飞行器航迹快速规划方法
CN113311869B (zh) 一种多约束条件下无人机路径规划方法
CN109857134A (zh) 基于A*/minimum_snap算法的无人机轨迹控制系统和方法
CN114828146A (zh) 一种基于神经网络和迭代学习的无人集群地理位置路由方法
CN110851911B (zh) 终端状态计算模型训练方法、控制序列搜索方法及装置
CN110986948B (zh) 一种基于奖励函数优化的多无人机分组协同判断方法
CN116953692A (zh) 一种主动雷达和被动雷达协同跟踪下的航迹关联方法
CN113490172B (zh) 一种基于正余弦优化与跳段优化的DV-Hop定位算法
CN115933736A (zh) 一种航迹快速规划精准控制飞行器的方法
CN113126647A (zh) 一种基于领导者跟追随者原理的协同制导方法
CN111506108B (zh) 基于误差校正点的无人机室内航迹规划装置及方法
CN113029150B (zh) 一种多约束条件下的智能飞行器航迹规划方法
CN113503891B (zh) 一种sinsdvl对准校正方法、系统、介质及设备
Xing et al. 3d trajectory planning of positioning error correction based on pso-a* algorithm
Li et al. Research on rapid planning of intelligent aircraft trajectory under multiple constraints

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
TA01 Transfer of patent application right
TA01 Transfer of patent application right

Effective date of registration: 20240328

Address after: 518000 1104, Building A, Zhiyun Industrial Park, No. 13, Huaxing Road, Henglang Community, Longhua District, Shenzhen, Guangdong Province

Applicant after: Shenzhen Hongyue Information Technology Co.,Ltd.

Country or region after: China

Address before: 710048 No. 5 Jinhua South Road, Shaanxi, Xi'an

Applicant before: XI'AN University OF TECHNOLOGY

Country or region before: China

TA01 Transfer of patent application right
TA01 Transfer of patent application right

Effective date of registration: 20240404

Address after: Room 403, 4th Floor, No. 1601-22, Guangzhou Avenue South, Haizhu District, Guangzhou City, Guangdong Province, 510220

Applicant after: Guangzhou Rongfu Digital Technology Service Co.,Ltd.

Country or region after: China

Address before: 518000 1104, Building A, Zhiyun Industrial Park, No. 13, Huaxing Road, Henglang Community, Longhua District, Shenzhen, Guangdong Province

Applicant before: Shenzhen Hongyue Information Technology Co.,Ltd.

Country or region before: China

GR01 Patent grant
GR01 Patent grant