一种基于空间几何特征的无人机航迹规划方法技术

本发明专利技术涉及一种基于空间几何特征的无人机航迹规划方法，首先通过对无人机的行为数据进行分析，对无人机的飞行条件及飞行环境进行分析，获得无人机的规划空间；随后通过对无人机行为的约束条件的描述，确定无人机的飞行限制函数，根据相应的环境约束及无人机自身飞行限制，给出最优目标函数，并通过空间几何特征，找到无人机的最优航迹。本发明专利技术具有如下特点：利用无人机的飞行限制和环境约束条件，能够将无人机的航迹规划问题形式化为空间几何特征；利用无人机的空间几何特征计算，针对不同飞行限制和环境约束条件下，能够给出无人机的最优航迹规划方法。

【技术实现步骤摘要】
一种基于空间几何特征的无人机航迹规划方法
本专利技术涉及一种无人机航迹规划方法。
技术介绍
随着无人机技术的发展，越来越多的无人机被应用于替代飞行员执行一些高危任务，诸多领域，如：搜救、灾害监测等。一个完善的任务规划系统是无人机顺利完成任务的重要保障，其中航迹规划则是任务规划系统的核心部分。无人机航迹规划要求无人机规划出最优或最满意的飞行航迹。因而，无人机航迹规划问题是提高无人机安全性能,保证无人机出色完成任务的重要手段。现有的无人机航迹规划技术主要采用优化算法和机器学习技术等。采用优化算法的技术主要通过采集三维地理数据，基于A-Star搜索、粒子群算法、蚁群算法等智能优化算法进行降维处理，将其转化为二维线性规划问题；基于机器学习、强化学习等相关算法模型技术，一般利用机器运算处理数据规划出多维出行方案，从而最优化无人机飞行路径规划航线。基于优化算法技术的二维航迹规划在军事突防、山地救援等应用中实用价值有限。基于机器学习、强化学习等相关算法模型的技术针对无人机中飞行数据属性有限或缺失某些行为属性的情况下，其较难准确给出最优航迹规划航线。
技术实现思路
本专利技术的目的是：研究基于空间几何特征的无人机航迹规划方法，通过分析无人机的飞行约束和环境限制，通过无人机的飞行高度限制将规划空间设定为相应的空间需求，并基于无人机飞行的空间几何特征规划出无人机的最优路径。为了达到上述目的，本专利技术的技术方案是提供了一种基于空间几何特征的无人机航迹规划方法，其特征在于，包括以下步骤：步骤1、确定无人机的航迹规划空间C，无人机初始坐标为c1＝(x1,y1,z1)，无人机目标坐标为cn＝(xn,yn,zn)，无人机第i个采样点坐标ci＝(xi,yi,zi)，i＝{1,2,…,n}，障碍区域为以(xr,yr,zr)为中心点，以r为半径的球限定无人机的飞行高度区间为[zr-r,zr+r]，进入步骤2；步骤2、获得无人机航迹Path表达形式，如式(1)所示，进入步骤3：Path＝{(c1,c2),…,(cn-1,cn)}(1)步骤3、获得约束条件，如式(2)及式(3)所示，进入步骤4：zr-r≤zi≤zr+r，i＝{1,2,…,n}(3)步骤4、获得确定航迹的目标函数P，如式(4)所示，进入步骤5：式(4)中，表示与ci-1与ci之间的距离；步骤5、若z1＝zn，将3维空间映射到2维空间，如果(xr,yr,zr)到直线(y1-yn)x-(x1-xn)y+(x1yn-xny1)＝0的距离大于r，那么连接(x1,y1,z1)到(xn,yn,zn)的直线就是最优路径，算法终止；否则，(xr,yr,zr)到直线(y1-yn)x-(x1-xn)y+(x1yn-xny1)＝0的距离小于等于r，那么执行步骤6；若z1≠zn，则执行步骤7步骤6、；在以(xr,yr)为中心，以r为半径的圆区域外，任意找到一点(xj,yj)，使得满足最小，那么路径{(c1,cj),(cj,cn)}即为最优路径，算法终止；步骤7、令(x1,y1,z1)、(xr,yr,zr)、(xn,yn,zn)组成的平面为二维平面C2，在二维平面C2上，执行步骤5，直到找到一个点(xk,yk,zk)，使得路径{(c1,ck),(ck,cn)}最小，那么路径{(c1,ck),(ck,cn)}即为最优路径，算法终止。本专利技术针对捕捉到的无人机行为数据，针对无人机的空间限定、环境约束及无人机自身的飞行高度限制等约束条件，形式化这些约束条件，并利用相应的环境限定给出相应的最优目标函数，并利用空间几何的特征，找出无人机的最优规划路径。本专利技术具有如下特点：(1)利用无人机的飞行限制和环境约束条件，能够将无人机的航迹规划问题形式化为空间几何特征；(2)利用无人机的空间几何特征计算，针对不同飞行限制和环境约束条件下，能够给出无人机的最优航迹规划方法。附图说明图1为无人机航迹规划实现架构图；图2为航迹规划算法的流程图；图3为实施例1中三维空间映射到二维空间且危险区域未涵盖连接的直线；图4为实施例2中三维空间映射到二维空间且危险区域未涵盖连接的直线；图5为实施例3中从(x1,y1,z1)和(xn,yn,zn)的直线未经过危险区域。具体实施方式下面结合具体实施例，进一步阐述本专利技术。应理解，这些实施例仅用于说明本专利技术而不用于限制本专利技术的范围。此外应理解，在阅读了本专利技术讲授的内容之后，本领域技术人员可以对本专利技术作各种改动或修改，这些等价形式同样落于本申请所附权利要求书所限定的范围。如图1所示，本专利技术提供的一种基于空间几何特征的无人机航迹规划方法总体包括以下步骤：首先第一阶段，通过分析无人机的飞行轨迹和飞行环境，构建规划空间，根据特殊的飞行要求，确定无人机是否在同一高度飞行。如果要求无人机在相同高度飞行，规划空间可以描述为二维空间。如果没有，规划空间可以描述为一个三维空间。然后，在第二阶段，根据约束条件，将约束条件描述为形式化，并对约束形式化进行了分析。第三阶段，通过分析无人机的飞行目标和优化目标，选择目标函数。然后根据不同的约束条件和目标，利用空间解析几何的相关知识计算出最优路径。具体而言，如图2所示，本专利技术包括以下算法步骤：步骤1、确定无人机的航迹规划空间C，无人机初始坐标为c1＝(x1,y1,z1)，无人机目标坐标为cn＝(xn,yn,zn)，无人机第i个采样点坐标ci＝(xi,yi,zi)，i＝{1,2,…,n}，障碍区域为以(xr,yr,zr)为中心点，以r为半径的球限定无人机的飞行高度区间为[zr-r,zr+r]，进入步骤2；步骤2、获得无人机航迹Path表达形式，如式(1)所示，进入步骤3：Path＝{(c1,c2),…,(cn-1,cn)}(1)步骤3、获得约束条件，如式(2)及式(3)所示，进入步骤4：zr-r≤zi≤zr+r，i＝{1,2,…,n}(3)步骤4、获得确定航迹的目标函数P，如式(4)所示，进入步骤5：式(4)中，表示与ci-1与ci之间的距离；步骤5、若z1＝zn，将3维空间映射到2维空间，如果(xr,yr,zr)到直线(y1-yn)x-(x1-xn)y+(x1yn-xny1)＝0的距离大于r，那么连接(x1,y1,z1)到(xn,yn,zn)的直线就是最优路径，算法终止；否则，(xr,yr,zr)到直线(y1-yn)x-(x1-xn)y+(x1yn-xny1)＝0的距离小于等于r，那么执行步骤6；若z1≠zn，则执行步骤7步骤6、；在以(xr,yr)为中心，以r为半径的圆区域外，任意找到一点(xj,yj)，使得满足最小，那么路径{(c1,cj),(cj,cn)}即为最优路径，算法终止；步骤7、令(x1,y1,z1)、(xr,yr,zr)、(xn,yn,zn)组成的平面为二维平面C2，在二维平面C2上，执行步骤5，直到找到一个点(xk,yk,zk)，使得路径{(c1,ck),(ck,cn)}最小，那么路径{(c1,ck),(ck,cn)}即为最优路径，算法终止。以下以几个简单的实施例来进一步说明本专利技术：实施例1对于一个无人机，当假设其限定飞行高度为固定高度时，我们可将规划空间映射到二维空间，如图3所示。在图3中，根据本专利技术提供的算法，首先我们容易想到通过坐标系的平移，将无人机的起本文档来自技高网...

【技术保护点】
1.一种基于空间几何特征的无人机航迹规划方法，其特征在于，包括以下步骤：步骤1、确定无人机的航迹规划空间C，无人机初始坐标为c1＝(x1，y1，z1)，无人机目标坐标为cn＝(xn，yn，zn)，无人机第i个采样点坐标ci＝(xi，yi，zi)，i＝{1，2，…，n｝，障碍区域为以(xr，yr，zr)为中心点，以r为半径的球

【技术特征摘要】
1.一种基于空间几何特征的无人机航迹规划方法，其特征在于，包括以下步骤：步骤1、确定无人机的航迹规划空间C，无人机初始坐标为c1＝(x1，y1，z1)，无人机目标坐标为cn＝(xn，yn，zn)，无人机第i个采样点坐标ci＝(xi，yi，zi)，i＝{1，2，…，n｝，障碍区域为以(xr，yr，zr)为中心点，以r为半径的球限定无人机的飞行高度区间为[zr-r，zr+r]，进入步骤2；步骤2、获得无人机航迹Path表达形式，如式(1)所示，进入步骤3：Path＝{(c1，c2)，…，(cn-1，cn)}(1)步骤3、获得约束条件，如式(2)及式(3)所示，进入步骤4：zr-r≤zi≤zr+r，i＝{1，2，…，n}(3)步骤4、获得确定航迹的目标函数P，如式(4)所示，进入步骤5：式(4)中，表示与ci-1与ci之间的距离；步骤5、若z1＝zn，将3维空间映射到2维空间，如...

【专利技术属性】
技术研发人员：赵培海，王咪咪，
申请(专利权)人：东华大学，
类型：发明
国别省市：上海,31