CN114355979A - 一种无人机航路自动规划的方法 - Google Patents
一种无人机航路自动规划的方法 Download PDFInfo
- Publication number
- CN114355979A CN114355979A CN202210009168.3A CN202210009168A CN114355979A CN 114355979 A CN114355979 A CN 114355979A CN 202210009168 A CN202210009168 A CN 202210009168A CN 114355979 A CN114355979 A CN 114355979A
- Authority
- CN
- China
- Prior art keywords
- unmanned aerial
- aerial vehicle
- route
- flight
- point
- 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
Links
Images
Classifications
-
- Y—GENERAL 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
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T10/00—Road transport of goods or passengers
- Y02T10/10—Internal combustion engine [ICE] based vehicles
- Y02T10/40—Engine management systems
Landscapes
- Traffic Control Systems (AREA)
- Navigation (AREA)
Abstract
本发明提供一种无人机航路自动规划的方法,包括划分出飞行管理区域、形成航路底图、选定起飞降落点、优化航路等步骤,通过对无人机的飞行航路进行规划,从而使无人机在飞行时能够规避碰撞的风险,提高飞行安全性。
Description
技术领域
本发明涉及无人机安全飞行领域,尤其涉及一种无人机航路自动规划的方法。
背景技术
低空空域为通用航空的作业区,不管工业飞行、农业飞行、空中旅游等,都运行于低空空域,低空空域的开放可以促成通用航空产业链的形成,从传统的农林服务、抢险救灾、航拍业务向多元化业务发展,例如,提供空中游览观光、培养飞行员、教学飞行、飞行表演、空中跳伞等可持续发展项目。
但是低空空域飞行的安全管理,依然是制约低空经济发展的一大因素。
现有的低空空域管理***中,当空域同时具有多架无人机进行飞行时,无法有效对无人机航路进行管理,从而存在安全隐患。
发明内容
本发明通过对无人机的飞行航路进行规划,从而使无人机在飞行时能够规避碰撞的风险,提高飞行安全性。
本发明通过以下方式实现:
一种无人机航路自动规划的方法,通过以下步骤进行航路规划:
S1. 基于三维地理信息***,划分出飞行管理区域;
S2. 在飞行管理区域边界内设置若干节点,相邻节点通过连线两两连接,形成航路底图;
S3. 接受无人机飞行任务选定的起飞点、降落点、起飞时间和降落时间的数据;
S4. 为无人机分配高度层;
S5. 形成约束条件,符合约束条件的连线和节点,予以标记为不可用;
S6. 以与选点起飞地点和降落地点距离最短的节点和连线为航路规划的起飞点和降落点,计算两点之间最短的连线,形成航路;
S7. 航路优化:
S71判断在时间段有重叠的航路中,是否有与本次规划的航路重叠的航路,是则进入下一步,否则认为该航路已经为最优航路;
S72列出飞行时间段有重叠且与本次规划的航路a1具有交叉点b的航路a2;
S73本次无人机的飞行的参考时速为v1,另一航路无人机的参考时速v2;预判出a1航路的无人机到达交叉点b的时刻为T1+t1;a2航路的无人机到达交叉点b的时刻为T2+t2;
S74当I(T2+t2)-(T1+T1)I大于安全时长时,允许航线交叉;若满足该条件,认定该航路为最优航路,若不满足该条件,进入下一步;
S75以交叉点b为圆心,以安全距离c为半径形成一临时禁区,将禁区内覆盖的节点和连线标记为不可用,之后重新回到步骤S6直至形成最优航路;
S8. 将所述最优航路信息反馈给无人机按航路执行飞行;
S9. 无人机依据最优航路飞行;实时接收无人机飞行数据并在三维地理信息***标记无人机实时位置。
进一步的,在S8中,当监测到无人机实时位置偏移航路且偏移量大于c时,发出预警,并在偏移点到其最优航路最近点之间重新规划航路,使其及时原定航路。
进一步的,S8中,实时对无人机飞行状态进行安全判断,判断步骤如下:
S81以无人机为中心,以c为半径形成一个保护圈;
S82不同无人机保护圈边缘是否相切或相交,如果是则认定为具有碰撞风险;
S83向具有碰撞风险的无人机发出预警;
S84碰撞规避:
(1)若所有无人机均没有出现偏移航路情况,则依次择一无人机进行路线重新规划,其他无人机暂时做悬停指令;
(2)若有无人机出现航路偏移,则依次先指令偏移航路的无人机予以路线重新规划,其他无人机暂时做悬停指令。
进一步的,所述路线通过以下方式进行重新规划:
S84在航路底图展示出所有在飞无人机航路,并在航路两侧添加一保护区;未完成飞行的航路保护区覆盖的节点和连线标记为不可用;在航路底图中,计算此时所在地点与降落点之间最短的连线,形成新航路。
进一步的,监测规划航路有交叉的无人机,判断以其实际飞行速度,到达交叉点的时刻是否符合S63的判断条件,如不满足条件,则指令无人机调整飞行速度,直到符合条件。
进一步的,所述S4约束条件包括禁飞区域,所述禁飞区域基于三维地理信息***划分。
本发明的有益效果是:
1.通过制作航路底图,实现无人机自动航路自动规划分配,使无人机在同一空域可以安全飞行,提高管理效率;
2.通过航路优化,实现无人机航路交叉规划,提高空域利用率;
3.实时监测无人机飞行位置,对于偏离航路的无人机予以路线重新规划,协助出现意外的无人机回归航路;
4.当实时在飞无人机出现碰撞风险时,依据航路底图为无人机重新规划路线,使其规避碰撞。
附图说明
图1为本发明航路规划流程图;
图2航路底图示意图;
图3为本发明安全判断流程示意图。
具体实施方式
一种无人机航路自动规划的方法,通过以下步骤进行航路规划:
S1基于三维地理信息***,划分出飞行管理区域;
S2在飞行管理区域边界内设置若干节点,相邻节点通过连线两两连接,形成航路底图;
节点的数量可以依据实际管理需要设置,节点越多,节点间距越小,则精细度越高。如图1所示,在本实施例中,节点均匀分布在飞行管理区域中。
S3接受无人机飞行任务选定的起飞点、降落点、起飞时间和降落时间的数据;
无人机飞行任务的数据还可以包括无人机飞行速度、无人机续航路程、空飞重量、最大载重等。
S4分配无人机高度层;
***中,可以根据不同类型无人机设置不同飞行高度层,形成飞行规范。同一类型的无人机分配在相同高度层。并且不同类型无人机之间的高度层需要有一定的隔离间距,形成多个不同高度的高度层。
比如空机重量不超过15千克且最大起飞重量不超过25千克,具备符合空域管理要求的空域保持能力和可靠被监视能力,全程可以随时人工介入操作的无人驾驶航空器,设置为小型无人机,分配飞行高度层在真高150米的空域。
最大起飞重量在25千克到150千克之间的无人驾驶航空器,设置为中型无人机,分配飞行高度在真高500米的空域。
最大起飞重量超过150千克的无人驾驶航空器,设置为大型无人机,分配的飞行高度在真高1500米的空域。
本实施例中,以中型无人机为例,在读取该无人机飞行任务申请后,将其分配在500米高程的空域进行航路规划。
S5形成约束条件,符合约束条件的连线和节点,予以标记为不可用;
S6以与选点起飞地点和降落地点距离最短的节点和连线为航路规划的起飞点和降落点,计算两点之间最短的连线,形成航路;
两点之间最短的连线是指两点之间连线连接组成的最短路径。
标记为不可用的节点和连线,在路线规划时将不予考虑。
由于用户选取的起飞地点和降落地点,并不一定都会与节点重合,因此需要选择距离最近的可用节点作为航路起点进行修正。
可采用dijskra、SPFA、Bellman-Ford、Floyd 、Floyd-Warshall、Johnson算法中的一种。
S7航路优化:
S71判断在时间段有重叠的航路中,是否有与本次规划的航路重叠的航路,是则进入下一步,否则认为该航路已经为最优航路;
S72列出飞行时间段有重叠且与本次规划的航路a1具有交叉点b的航路a2;
S73本次无人机的飞行的参考时速为v1,另一航路无人机的参考时速v2;预判出a1航路的无人机到达交叉点b的时刻为T1+t1;a2航路的无人机到达交叉点b的时刻为T2+t2;
S74当I(T2+t2)-(T1+T1)I大于安全时长,允许航线交叉;若不满足该条件,进入下一步;
S75以交叉点b为圆心,以安全距离c为半径形成一临时禁区,将禁区内覆盖的节点和连线标记为不可用,之后重新回到步骤S6直至形成最优航路;
由于分配在同个高度层进行航路的规划的无人机在机型、航速等方面均较为接近,因此可以统一设置安全时长和安全距离c。
步骤S75中,通过设置临时禁区,使本次规划可以绕开交叉点,重新规划路线。
S8将所述最优航路信息反馈给无人机按航路执行飞行;
S9无人机依据最优航路飞行;实时接收无人机飞行数据并在三维地理信息***标记无人机实时位置。
进一步的,在S8中,当监测到无人机实时位置偏移航路且偏移量大于c时,发出预警,并在偏移点到其最优航路最近点之间重新规划航路,使其及时原定航路。
进一步的,S8中,实时对无人机飞行状态进行安全判断,判断步骤如下:
S81以无人机为中心,以c为半径形成一个保护圈;
S82不同无人机保护圈是否相切或相交,如果是则认定为具有碰撞风险;
S83向具有碰撞风险的无人机发出预警;
S84碰撞规避:
(1)若所有无人机均没有出现偏移航路情况,则依次择一无人机进行路线重新规划,其他无人机暂时做悬停指令;
(2)若有无人机出现航路偏移,则依次先指令偏移航路的无人机予以路线重新规划,其他无人机暂时做悬停指令。
优先疏散偏移航路的无人机,确保航路安全性。
进一步的,所述路线通过以下方式进行重新规划:
S84在航路底图展示出所有在飞无人机航路,并在航路两侧添加一保护区;未完成飞行的航路保护区覆盖的节点和连线标记为不可用;在航路底图中,计算此时所在地点与降落点之间最短的连线,形成新航路。
进一步的,监测规划航路有交叉的无人机,判断以其实际飞行速度,到达交叉点的时刻是否符合S74的判断条件,如不满足条件,则指令无人机调整飞行速度,直到符合条件。
Claims (6)
1.一种无人机航路自动规划的方法,通过以下步骤进行航路规划:
基于三维地理信息***,划分出飞行管理区域;
在飞行管理区域边界内设置若干节点,相邻节点通过连线两两连接,形成航路底图;
接受无人机飞行任务选定的起飞点、降落点、起飞时间和降落时间的数据;
为无人机分配高度层;
形成约束条件,符合约束条件的连线和节点,予以标记为不可用;
以与选点起飞地点和降落地点距离最短的节点和连线为航路规划的起飞点和降落点,计算两点之间最短的连线,形成航路;
航路优化:
S71判断在时间段有重叠的航路中,是否有与本次规划的航路重叠的航路,是则进入下一步,否则认为该航路已经为最优航路;
S72列出飞行时间段有重叠且与本次规划的航路a1具有交叉点b的航路a2;
S73本次无人机的飞行的参考时速为v1,另一航路无人机的参考时速v2;预判出a1航路的无人机到达交叉点b的时刻为T1+t1;a2航路的无人机到达交叉点b的时刻为T2+t2;
S74当I(T2+t2)-(T1+T1)I大于安全时长时,允许航线交叉;若满足该条件,认定该航路为最优航路,若不满足该条件,进入下一步;
S75以交叉点b为圆心,以安全距离c为半径形成一临时禁区,将禁区内覆盖的节点和连线标记为不可用,之后重新回到步骤S6直至形成最优航路;
将所述最优航路信息反馈给无人机按航路执行飞行;
无人机依据最优航路飞行;实时接收无人机飞行数据并在三维地理信息***标记无人机实时位置。
2.根据权利要求1所述方法,其特征在于,在S8中,当监测到无人机实时位置偏移航路且偏移量大于c时,发出预警,并在偏移点到其最优航路最近点之间重新规划航路,使其及时原定航路。
3.根据权利要求2所述方法,其特征在于,S8中,实时对无人机飞行状态进行安全判断,判断步骤如下:
S81以无人机为中心,以c为半径形成一个保护圈;
S82不同无人机保护圈边缘是否相切或相交,如果是则认定为具有碰撞风险;
S83向具有碰撞风险的无人机发出预警;
S84碰撞规避:
若所有无人机均没有出现偏移航路情况,则依次择一无人机进行路线重新规划,其他无人机暂时做悬停指令;
若有无人机出现航路偏移,则依次先指令偏移航路的无人机予以路线重新规划,其他无人机暂时做悬停指令。
4.根据权利要求3所述方法,其特征在于,所述路线通过以下方式进行重新规划:
S84在航路底图展示出所有在飞无人机航路,并在航路两侧添加一保护区;未完成飞行的航路保护区覆盖的节点和连线标记为不可用;在航路底图中,计算此时所在地点与降落点之间最短的连线,形成新航路。
5.根据权利要求1所述方法,其特征在于,监测规划航路有交叉的无人机,判断以其实际飞行速度,到达交叉点的时刻是否符合S63的判断条件,如不满足条件,则指令无人机调整飞行速度,直到符合条件。
6.根据权利要求1所述方法,其特征在于,所述S4约束条件包括禁飞区域,所述禁飞区域基于三维地理信息***划分。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210009168.3A CN114355979B (zh) | 2022-01-06 | 2022-01-06 | 一种无人机航路自动规划的方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210009168.3A CN114355979B (zh) | 2022-01-06 | 2022-01-06 | 一种无人机航路自动规划的方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114355979A true CN114355979A (zh) | 2022-04-15 |
CN114355979B CN114355979B (zh) | 2023-04-25 |
Family
ID=81106949
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210009168.3A Active CN114355979B (zh) | 2022-01-06 | 2022-01-06 | 一种无人机航路自动规划的方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114355979B (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114743408A (zh) * | 2022-04-18 | 2022-07-12 | 北京大唐永盛科技发展有限公司 | 基于网格化的低空飞行管理*** |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106781707A (zh) * | 2016-12-21 | 2017-05-31 | 华北计算技术研究所(中国电子科技集团公司第十五研究所) | 一种针对低空中长距离转场飞行的航迹规划方法 |
CN109814598A (zh) * | 2019-02-25 | 2019-05-28 | 中国科学院地理科学与资源研究所 | 无人机低空公共航路网设计方法 |
CN110320931A (zh) * | 2019-06-20 | 2019-10-11 | 西安爱生技术集团公司 | 基于航向控制律的无人机避障航路规划方法 |
CN110850891A (zh) * | 2019-11-11 | 2020-02-28 | 西北工业大学 | 一种基于空间和时间协同的多无人机动态航路规划方法 |
CN112817330A (zh) * | 2021-01-05 | 2021-05-18 | 北京联合大学 | 一种多无人机四维航迹协同规划方法及*** |
CN113310491A (zh) * | 2021-05-17 | 2021-08-27 | 北京航空航天大学 | 一种考虑具体结构的无人机航路网自动生成方法 |
US20210373580A1 (en) * | 2020-05-21 | 2021-12-02 | Edgar Emilio Morales Delgado | System and method for autonomous air traffic control of unmanned aerial vehicles |
-
2022
- 2022-01-06 CN CN202210009168.3A patent/CN114355979B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106781707A (zh) * | 2016-12-21 | 2017-05-31 | 华北计算技术研究所(中国电子科技集团公司第十五研究所) | 一种针对低空中长距离转场飞行的航迹规划方法 |
CN109814598A (zh) * | 2019-02-25 | 2019-05-28 | 中国科学院地理科学与资源研究所 | 无人机低空公共航路网设计方法 |
CN110320931A (zh) * | 2019-06-20 | 2019-10-11 | 西安爱生技术集团公司 | 基于航向控制律的无人机避障航路规划方法 |
CN110850891A (zh) * | 2019-11-11 | 2020-02-28 | 西北工业大学 | 一种基于空间和时间协同的多无人机动态航路规划方法 |
US20210373580A1 (en) * | 2020-05-21 | 2021-12-02 | Edgar Emilio Morales Delgado | System and method for autonomous air traffic control of unmanned aerial vehicles |
CN112817330A (zh) * | 2021-01-05 | 2021-05-18 | 北京联合大学 | 一种多无人机四维航迹协同规划方法及*** |
CN113310491A (zh) * | 2021-05-17 | 2021-08-27 | 北京航空航天大学 | 一种考虑具体结构的无人机航路网自动生成方法 |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114743408A (zh) * | 2022-04-18 | 2022-07-12 | 北京大唐永盛科技发展有限公司 | 基于网格化的低空飞行管理*** |
Also Published As
Publication number | Publication date |
---|---|
CN114355979B (zh) | 2023-04-25 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CA2796923C (en) | Determining landing sites for aircraft | |
US10332405B2 (en) | Unmanned aircraft systems traffic management | |
US9257048B1 (en) | Aircraft emergency landing route system | |
CN112489498B (zh) | 一种航路交通精细改航规划方法 | |
CN106781707B (zh) | 一种针对低空中长距离转场飞行的航迹规划方法 | |
WO2023019890A1 (zh) | 一种多无人机自动作业调度***及调度方法 | |
CN104991895A (zh) | 一种基于三维空域网格的低空救援航空器航迹规划方法 | |
US20140343765A1 (en) | Flight Assistant with Automatic Configuration and Landing Site Selection | |
US20200393852A1 (en) | Three dimensional aircraft autonomous navigation under constraints | |
KR20170080354A (ko) | 무인기 안전 비행을 위한 가상적 스카이웨이와 이를 적용한 관제시스템 및 무인기 항법장치와 서비스 | |
Sedov et al. | Centralized and distributed UTM in layered airspace | |
US10984664B2 (en) | System for determining potential landing sites for aircraft prior to landing assist device deployment | |
CN114355978A (zh) | 一种无人机低空飞行管理方法 | |
Cotton et al. | Airborne trajectory management for urban air mobility | |
US20230237917A1 (en) | A Method and System for Controlling Flight Movements of Air Vehicles | |
CN114676592B (zh) | 低空飞行网格化管理方法 | |
CN114355979B (zh) | 一种无人机航路自动规划的方法 | |
US20210295715A1 (en) | Uav (unmanned aerial vehicle) logistic operational mission planning and management system and method thereof | |
CN113920784A (zh) | 一种通信方法、装置及存储介质 | |
WO2019177291A1 (ko) | 에어웨이 설정방법 | |
Vajda et al. | A Systematic Approach to Developing Paths Towards Airborne Vehicle Autonomy | |
CN111142555A (zh) | 一种基于碰撞风险的机场无人机管控区域划设方法 | |
CN117649785A (zh) | 一种无人机多运行人分布式协同冲突化解方法及*** | |
US20230410666A1 (en) | 3d space data generation method, device and computer program for flight guidance of aircraft | |
CN114545961A (zh) | 无人机航线生成方法、装置、设备和计算机可读存储介质 |
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 | ||
GR01 | Patent grant | ||
GR01 | Patent grant |