CN107943099A - 一种无人机地形高度跟随控制方法及系统 - Google Patents
一种无人机地形高度跟随控制方法及系统 Download PDFInfo
- Publication number
- CN107943099A CN107943099A CN201810035160.8A CN201810035160A CN107943099A CN 107943099 A CN107943099 A CN 107943099A CN 201810035160 A CN201810035160 A CN 201810035160A CN 107943099 A CN107943099 A CN 107943099A
- Authority
- CN
- China
- Prior art keywords
- point
- unmanned plane
- terrain
- height
- filtering
- 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.)
- Pending
Links
- 238000000034 method Methods 0.000 title claims abstract description 27
- 238000012544 monitoring process Methods 0.000 claims abstract description 3
- 238000001914 filtration Methods 0.000 claims description 21
- 238000012545 processing Methods 0.000 claims description 9
- 230000009194 climbing Effects 0.000 claims description 8
- 230000000694 effects Effects 0.000 claims description 3
- 238000000205 computational method Methods 0.000 claims description 2
- 238000002474 experimental method Methods 0.000 claims description 2
- 238000003780 insertion Methods 0.000 claims description 2
- 230000037431 insertion Effects 0.000 claims description 2
- 239000011159 matrix material Substances 0.000 claims description 2
- 238000004088 simulation Methods 0.000 claims description 2
- 230000000630 rising effect Effects 0.000 claims 1
- 239000003208 petroleum Substances 0.000 description 3
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000005540 biological transmission Effects 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 238000013507 mapping Methods 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 238000012360 testing method Methods 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/10—Simultaneous control of position or course in three dimensions
- G05D1/101—Simultaneous control of position or course in three dimensions specially adapted for aircraft
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
一种无人机地形高度跟随控制方法及系统,其特征在于以下步骤,先后为地形数据装载,地形跟随预处理,航线自动规划,依据所述地形跟随预处理得到的所有目标跟随点,对应到地图的相应位置上,基于无人机地面监控站自动生成该条线路的高度跟随航线规划,生成结束后,装订到无人机飞行任务队列,无人机基于GPS+气压机做出不同高度下的飞行任务,通过本方案,无人机在远距离超低空自主飞行时,在地形的起伏复杂时,飞行器通过地形高度预处理,自主匹配对低高度飞行,可以避免由于飞行过低而撞山或建筑物等,保证飞行安全。
Description
技术领域
本发明涉及无人机应用领域,特别是一种无人机的地形高度跟随控制领域。
背景技术
现今无人机在高度保持的控制方法上,主要依赖GPS、气压传感器等。无人机利用传感器测得的飞行高度,通过主控芯片处理,并经由多级PID反馈控制器传递,最终实现无人机的高度保持。但是单纯依赖传感器的定高策略不能够测得无人机与地面间的相对距离,以至无法实现地形的跟随保持。如下表所示传统的无人机定高策略,存在使用条件限制、成本要求高、技术难度大等问题。
传统的基于定高飞行控制系统,在远距离超低空自主飞行时,由于地形的起伏,飞行器无法自主匹配对低高度飞行,引起由于飞行过低而撞山或建筑物等,飞行安全无法保证。
其次,针对某些特殊场景,如地理测绘、石油管道巡线等,检测设备测量结果的有效性对高度要求严格,必须保证对地高度在一定范围内,而传统无人机定高飞行控制无法针对地形进行高度跟随,从而无法满足需求。
发明内容
本发明的目的在于提供一种无人机地形高度跟随控制方法及系统能够特殊场景下无人机的飞行安全,本发明的技术方案是这样实现的:
一种无人机地形高度跟随控制方法,其特征在于包括以下步骤:
步骤一、地形数据装载:用于获取在任意地理位置下对应的地理地形海拔高度,获取方式包括基于SRTM地形产品数据、基于人为激光雷达飞行实测数据;
步骤二、地形跟随预处理:
第1步、移动平均滤波:在地形跟随预处理系统中将已知路线地形数据导入,设定高度采集点距离,再根据整条路线所有采集位置点从地理地形数据数据库中得到对应点海拔高度,并移动平均滤波,滤波器模型如下:
yy=smooth(y,span,method)
其中yy为移动平均滤波结果;y为滤波前原始数据;span为滤波器窗宽;method为指定滤波平滑方法;
地形跟随预处理中,地形高度移动平均滤波后结果filter_result通过所述滤波模型进行计算获得,模型参数通过试验和仿真测试结果设定最佳值。
第2步、计算所有极值点
对地形高度移动平均滤波后结果(filter_result)求二阶导求二阶导数,在利用Matlab 的find方法计算数据的极值点,如下极值点计算式:
x_min=find(diff(sign(diff(filter_result)))>0)+1
x_max=find(diff(sign(diff(filter_result)))<0)+1
其中find为MATLAB中找到矩阵或者是数组,向量中的非零元素;diff为MATLAB中计算一阶导数;x_min为该极低点即波谷对应的位置点;x_max为该极高点即波峰对应的位置点;
第3步、人为高通滤波
对所述步骤三中得到的极值数据做二次滤波,设定极值高度差即高通临界值,处理所有获取的极值点,判断相邻极值点的高度差,在连续的极值点高度差均小于设定值时,取循环处理的首个判断点和满足此条件的最后一个判断点,过滤中间大量的参考点,减少跟随目标点数,在处理过程中,所有最初输出的路线参考点均作为有效点归入目标跟随点;
第4步、插值处理
由于无人机飞行上升速率(固定翼为爬升速率)的限制,判断所有处理后的相邻目标点,如相邻目标点高度变化率小于无人机飞行上升速率,则执行第5步;如相邻目标点高度变化率大于无人机飞行上升速率,则基于判断点进行插值处理。计算插值点距离判断点的水平距离S,插值点高度设置为插入点水平位置处前后相邻两个目标点跟随高度的平均值,完成所有相邻目标点判断并插值后得到完整的地形高度跟随目标点;
如判断插值后所有相邻目标点高度变化率均小于无人机飞行上升速率,则执行第5步;
第5步、跟随高度效果评估
通过估测目标高度和实际的地形海拔高度做差得出整条路线的对地飞行高度,判断对地高度误差范围;
步骤三、航线自动规划:依据所述地形跟随预处理得到的所有目标跟随点,对应到地图的相应位置上,基于无人机地面监控站自动生成该条线路的高度跟随航线规划,生成结束后,装订到无人机飞行任务队列,无人机基于GPS+气压机做出不同高度下的飞行任务。优选的,第4步中所述插值点距离判断点的水平距离S的计算方法为:
其中S为插值点距离判断点的水平距离;
H为相邻两目标点两点高度差;
Vv为上升速率为,Vh为水平速率。
优选的,无人机地形高度跟随系统的特征是采用了所述无人机地形高度跟随控制方法。
本发明的有益效果为:利用本发明设计方案的一种无人机地形高度跟随控制方法及系统,在远距离超低空自主飞行时,在地形的起伏复杂时,飞行器通过地形高度预处理,自主匹配对低高度飞行,可以避免由于飞行过低而撞山或建筑物等,保证飞行安全。
附图说明
图1是新疆某石油管道地形海拔高度变化曲线
图2是新疆180公里地形高度跟随处理结果
实施例
如图1的实验试验场地为新疆某石油管线,采用本发明的技术方案。
如图1新疆某石油管道地形海拔高度变化,地形海拔高度范围:920m-1060m。
如图2为采用发明的技术方案的地形高度跟随处理结果,对地高度误差范围:-33m到+48m。
结果分析对比如下:
因此,通过两种方案对比发现:本方案的对地高度误差范围小,在远距离超低空自主飞行时,在地形的起伏复杂时,飞行器通过地形高度预处理,自主匹配对低高度飞行,可以避免由于飞行过低而撞山或建筑物等,保证飞行安全。
Claims (3)
1.一种无人机地形高度跟随控制方法,其特征在于包括以下步骤:
步骤一、地形数据装载:用于获取在任意地理位置下对应的地理地形海拔高度,获取方式包括基于SRTM地形产品数据、基于人为激光雷达飞行实测数据;
步骤二、地形跟随预处理:
第1步、移动平均滤波:在地形跟随预处理系统中将已知路线地形数据导入,设定高度采集点距离,再根据整条路线所有采集位置点从地理地形数据数据库中得到对应点海拔高度,并移动平均滤波,滤波器模型如下:
yy=smooth(y,span,method)
其中yy为移动平均滤波结果;y为滤波前原始数据;span为滤波器窗宽;method为指定滤波平滑方法;
地形跟随预处理中,地形高度移动平均滤波后结果filter_result通过所述滤波模型进行计算获得,模型参数通过试验和仿真测试结果设定最佳值;
第2步、计算所有极值点
对所述地形高度移动平均滤波后结果filter_result求二阶导数,在利用Matlab的find方法计算数据的极值点,如下极值点计算式:
x_min=find(diff(sign(diff(filter_result)))>0)+1
x_max=find(diff(sign(diff(filter_result)))<0)+1
其中find为MATLAB中找到矩阵或者是数组,向量中的非零元素;diff为MATLAB中计算一阶导数;x_min为该极低点即波谷对应的位置点;x_max为该极高点即波峰对应的位置点;
第3步、人为高通滤波
对步骤三中得到的所述极值点数据做二次滤波,设定极值高度差,处理所有获取的所述极值点,判断相邻极值点的高度差,在连续的所述极值点高度差均小于设定值时,取循环处理的首个判断点和满足此条件的最后一个判断点,过滤中间大量的参考点,减少跟随目标点数,在处理过程中,所有最初输出的路线参考点均作为有效点归入目标跟随点;
第4步、插值处理
判断所有处理后的相邻目标点高度差,如相邻目标点高度变化率小于无人机飞行上升速率,则执行第5步;如相邻目标点高度变化率大于无人机飞行上升速率,则基于判断点进行插值处理,计算插值点距离判断点的水平距离S,插值点高度设置为插入点水平位置处前后相邻两个目标点跟随高度的平均值,完成所有相邻目标点判断并插值后得到完整的地形高度跟随目标点;
如判断插值后所有相邻目标点高度变化率均小于无人机飞行上升速率,则执行第5步;
第5步、跟随高度效果评估
通过估测目标高度和实际的地形海拔高度做差得出整条路线的对地飞行高度,判断对地高度误差范围;
步骤三、航线自动规划:依据所述地形跟随预处理得到的所有目标跟随点,对应到地图的相应位置上,基于无人机地面监控站自动生成该条线路的高度跟随航线规划,生成结束后,装订到无人机飞行任务队列,无人机基于GPS+气压机做出不同高度下的飞行任务。
2.如权利要求1中所述的一种无人机地形高度跟随控制方法,其特征在于:第4步中所述插值点距离判断点的水平距离S的计算方法为:
<mrow>
<mi>S</mi>
<mo>=</mo>
<mfrac>
<mi>H</mi>
<msub>
<mi>V</mi>
<mi>v</mi>
</msub>
</mfrac>
<mo>&times;</mo>
<msub>
<mi>V</mi>
<mi>h</mi>
</msub>
</mrow>
其中S为插值点距离判断点的水平距离;
H为相邻两目标点两点高度差;
Vv为上升速率为,Vh为水平速率。
3.一种无人机地形高度跟随系统,其特征在于:所述的无人机地形高度跟随系统还包括权利要求1或2中所述的一种无人机地形高度跟随控制方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810035160.8A CN107943099A (zh) | 2018-01-15 | 2018-01-15 | 一种无人机地形高度跟随控制方法及系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810035160.8A CN107943099A (zh) | 2018-01-15 | 2018-01-15 | 一种无人机地形高度跟随控制方法及系统 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN107943099A true CN107943099A (zh) | 2018-04-20 |
Family
ID=61938673
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810035160.8A Pending CN107943099A (zh) | 2018-01-15 | 2018-01-15 | 一种无人机地形高度跟随控制方法及系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107943099A (zh) |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108930890A (zh) * | 2018-07-20 | 2018-12-04 | 辽宁工业大学 | 一种用于驾驶辅助系统实验平台的可移动式外置显示屏支架及其控制方法 |
CN109298722A (zh) * | 2018-11-05 | 2019-02-01 | 苏州极目机器人科技有限公司 | 地形跟随飞行方法、地形跟随飞行控制方法和作业方法 |
CN109520470A (zh) * | 2018-09-28 | 2019-03-26 | 甘肃启远智能科技有限责任公司 | 一种无人机巡检航路中航高参数的确定方法 |
CN110709791A (zh) * | 2018-08-01 | 2020-01-17 | 广州极飞科技有限公司 | 用于无人机的飞行高度调整、飞行控制的方法和装置 |
CN116360506A (zh) * | 2023-06-02 | 2023-06-30 | 深圳高度创新技术有限公司 | 无人飞行器的路径规划方法、系统、无人飞行器及介质 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104049636A (zh) * | 2014-05-27 | 2014-09-17 | 北京航空航天大学 | 一种融合相对高度和绝对高度获得导航高度的方法 |
CN105241466A (zh) * | 2015-11-02 | 2016-01-13 | 中山大学 | 一种飞行器三维导航方法及其装置 |
US20160047657A1 (en) * | 2013-03-25 | 2016-02-18 | Raytheon Company | Autonomous range-only terrain aided navigation |
CN105824322A (zh) * | 2016-05-11 | 2016-08-03 | 飞智控(天津)科技有限公司 | 基于激光雷达的无人机地形跟随系统及方法 |
CN106774435A (zh) * | 2017-01-20 | 2017-05-31 | 亿航智能设备(广州)有限公司 | 一种无人机的高精度跟随方法及其系统 |
-
2018
- 2018-01-15 CN CN201810035160.8A patent/CN107943099A/zh active Pending
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20160047657A1 (en) * | 2013-03-25 | 2016-02-18 | Raytheon Company | Autonomous range-only terrain aided navigation |
CN104049636A (zh) * | 2014-05-27 | 2014-09-17 | 北京航空航天大学 | 一种融合相对高度和绝对高度获得导航高度的方法 |
CN105241466A (zh) * | 2015-11-02 | 2016-01-13 | 中山大学 | 一种飞行器三维导航方法及其装置 |
CN105824322A (zh) * | 2016-05-11 | 2016-08-03 | 飞智控(天津)科技有限公司 | 基于激光雷达的无人机地形跟随系统及方法 |
CN106774435A (zh) * | 2017-01-20 | 2017-05-31 | 亿航智能设备(广州)有限公司 | 一种无人机的高精度跟随方法及其系统 |
Non-Patent Citations (7)
Title |
---|
FLORIAN HOLZAPFEL 等: "《航天制导、导航与控制的进展》", 31 January 2016, 国防工业出版社 * |
TONISCHENK: "《数字摄影测量学 背景、基础、自动定向过程》", 30 September 2009, 武汉大学出版社 * |
张小红 等: "《导航学》", 31 May 2017, 武汉大学出版社 * |
徐振平: "《普通高等教育"十三五"规划教材 机器人控制技术基础 基于Arduino的四旋翼飞行器设计与实现》", 30 April 2017, 国防工业出版社 * |
栾恩杰 等: "《国防科技名词大典 电子》", 31 January 2002, 航空工业出版社 * |
毛红保 等: "《无人机任务规划》", 31 January 2015, 国防工业出版社 * |
谢中华: "《MATLAB统计分析与应用 40个案例分析》", 31 May 2015, 北京航空航天大学出版社 * |
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108930890A (zh) * | 2018-07-20 | 2018-12-04 | 辽宁工业大学 | 一种用于驾驶辅助系统实验平台的可移动式外置显示屏支架及其控制方法 |
CN108930890B (zh) * | 2018-07-20 | 2023-08-01 | 辽宁工业大学 | 一种用于驾驶辅助系统实验平台的可移动式外置显示屏支架及其控制方法 |
CN110709791A (zh) * | 2018-08-01 | 2020-01-17 | 广州极飞科技有限公司 | 用于无人机的飞行高度调整、飞行控制的方法和装置 |
CN110709791B (zh) * | 2018-08-01 | 2022-12-27 | 广州极飞科技股份有限公司 | 用于无人机的飞行高度调整、飞行控制的方法和装置 |
CN109520470A (zh) * | 2018-09-28 | 2019-03-26 | 甘肃启远智能科技有限责任公司 | 一种无人机巡检航路中航高参数的确定方法 |
CN109298722A (zh) * | 2018-11-05 | 2019-02-01 | 苏州极目机器人科技有限公司 | 地形跟随飞行方法、地形跟随飞行控制方法和作业方法 |
CN116360506A (zh) * | 2023-06-02 | 2023-06-30 | 深圳高度创新技术有限公司 | 无人飞行器的路径规划方法、系统、无人飞行器及介质 |
CN116360506B (zh) * | 2023-06-02 | 2023-08-18 | 深圳高度创新技术有限公司 | 无人飞行器的路径规划方法、系统、无人飞行器及介质 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107943099A (zh) | 一种无人机地形高度跟随控制方法及系统 | |
CN109933086B (zh) | 基于深度q学习的无人机环境感知与自主避障方法 | |
CN107544548B (zh) | 控制无人机作业的方法、装置及无人机 | |
US7640797B2 (en) | Method and system for increasing safety in chemical application from an aircraft | |
CN106403948A (zh) | 用于输电线路巡检无人机的三维航迹规划方法 | |
CN108614274B (zh) | 基于多旋翼无人机的交叉式跨越线距离测量方法及装置 | |
CN106681344A (zh) | 一种用于飞行器的高度控制方法及控制系统 | |
CN104865971B (zh) | 一种输电线路巡检无人机的控制方法及无人机 | |
CN107950506A (zh) | 移动装置、基于移动装置的喷洒控制方法及装置 | |
CN104268423B (zh) | 大尺度动态演化沙尘型气溶胶反演方法 | |
CN109683629B (zh) | 基于组合导航和计算机视觉的无人机电力架线系统 | |
CN109792951B (zh) | 用于杂交水稻授粉的无人机航线校正系统及其校正方法 | |
CN110673628B (zh) | 一种复合翼无人机油气管线巡检方法 | |
US10866593B2 (en) | Aerial vehicle landing method, ground control system, and flight control system | |
CN107444665A (zh) | 一种无人机自主降落方法 | |
CN103941233B (zh) | 一种多平台主被动传感器协同跟踪的雷达间歇交替辐射控制方法 | |
CN110703802A (zh) | 基于多无人机协同作业的桥梁自动检测方法及系统 | |
CN106933243A (zh) | 一种基于双目视觉的无人机实时避障系统及方法 | |
CN107608371A (zh) | 城市社区环境下四旋翼自主避障无人机 | |
CN112326686A (zh) | 无人机智能巡航路面病害检测方法、无人机和检测系统 | |
CN107608386A (zh) | 一种基于高压线电磁指纹分布的无人机导航系统及方法 | |
CN106768123A (zh) | 一种无人直升机燃油预估方法 | |
CN107783548A (zh) | 基于多传感器信息融合技术的数据处理方法 | |
CN107783549A (zh) | 基于多传感器信息融合技术的单旋翼植保无人机避障系统 | |
US20210055417A1 (en) | Methods for generating treatment prescriptions based on uav-derived plant height data and related crop management systems |
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 | ||
RJ01 | Rejection of invention patent application after publication | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20180420 |