CN106595577A - 一种强风条件下四旋翼无人机高度测量方法 - Google Patents
一种强风条件下四旋翼无人机高度测量方法 Download PDFInfo
- Publication number
- CN106595577A CN106595577A CN201611255899.7A CN201611255899A CN106595577A CN 106595577 A CN106595577 A CN 106595577A CN 201611255899 A CN201611255899 A CN 201611255899A CN 106595577 A CN106595577 A CN 106595577A
- Authority
- CN
- China
- Prior art keywords
- height
- subfilter
- elevation information
- information
- output
- 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
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C5/00—Measuring height; Measuring distances transverse to line of sight; Levelling between separated points; Surveyors' levels
- G01C5/005—Measuring height; Measuring distances transverse to line of sight; Levelling between separated points; Surveyors' levels altimeters for aircraft
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C5/00—Measuring height; Measuring distances transverse to line of sight; Levelling between separated points; Surveyors' levels
- G01C5/06—Measuring height; Measuring distances transverse to line of sight; Levelling between separated points; Surveyors' levels by using barometric means
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/01—Satellite radio beacon positioning systems transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
- G01S19/13—Receivers
- G01S19/14—Receivers specially adapted for specific applications
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Computer Networks & Wireless Communication (AREA)
- Navigation (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
Abstract
本发明提供一种强风条件下四旋翼无人机高度测量方法,所述方法通过加速计提供的第一高度信息、气压高度计提供的第二高度信息、GPS接收机提供的第三高度信息和北斗接收机提供的第四高度信息,进行联邦级联滤波器构建,完成高度滤波输出,实现高度测量,本发明的可以在失效状态,卫星导航测量高度存在较大噪声且滞后严重的条件下直接测量高度;反馈调节可以增强***鲁棒性,不影响飞行安全。
Description
技术领域
本发明属于无人机导航技术领域,具体涉及一种强风条件下四旋翼无人机高度测量方法。
背景技术
目前无人机高度测量方法主要包括气压高度,卫星导航,超声波,激光,雷达等,由于四旋翼负载能力有限,激光与雷达适用性不高,超声波测高由于测量距离较近也不能满足多数场合要求。
强风条件下四旋翼无人机高度测量难度增加,强气流使气压高度测量受扰动较大,且机体工作环境恶劣,震动剧烈,惯性传感器精度变差,甚至可能出现失效状态,卫星导航测量高度存在较大噪声且滞后严重。强风条件下高度测量精度直接影响飞行安全,因此需要一种针对强风条件下四旋翼无人机的高度测量技术。
发明内容
为了解决上述问题,本发明提供一种强风条件下四旋翼无人机高度测量方法,所述方法通过加速计提供的第一高度信息、气压高度计提供的第二高度信息、GPS接收机提供的第三高度信息和北斗接收机提供的第四高度信息,进行联邦级联滤波器构建,完成高度滤波输出,实现高度测量;
进一步地,所述方法包括:
S1:利用加速度计的垂向加速度信息进行积分,得到第一高度信息;
S2:利用气压高度计获取第二高度信息、GPS接收机获取第三高度信息、以及北斗接收机获取第四高度信息;
S3:将第一高度信息和第二高度信息都输入到第一子滤波器中,将第一高度信息和第三高度信息输入到第二子滤波器中,将第一高度信息和第四高度信息输入到第三子滤波器中;
S4:将各子滤波器中内容输出到主滤波器中,根据各传感器特点分配各子滤波器权重,构建联邦级联滤波器;
S5:对强风条件下四旋翼无人机高度信息进行滤波估计,输出高度滤波;
S6:通过S5中输出的高度滤波,对各传感器输入进行故障检测;
进一步地,S1中所述利用加速度计的垂向加速度信息进行积分具体为通过垂向加速度信息进行高度积分;
进一步地,S4中所述各子滤波器的滤波参数由加速度计积分高度输出方差R1、气压高度输出方差R2、GPS接收机输出方差R3、北斗接收机输出方差R4确定,其中第一子滤波器滤波参数Q阵为R1、R阵为R2,第二子滤波器滤波参数Q阵为R1、R阵为R3,第三子滤波器滤波参数Q阵为R1、R阵为R4;
进一步地,S1中所述的第一高度信息为具有高频响应特性的高度信息;
进一步地,S4中所述根据各传感器特点分配各子滤波器权重,S4中所述根据各传感器特点分配各子滤波器权重,其中第一子滤波器输出为A1,第二滤波器输出为A2,第三滤波器输出为A3,主滤波器输出为A,构建联邦级联滤波器具体为
进一步地,S6中所述故障检测方法为若偏差超过阈值则实时隔离故障传感器;
本发明的有益效果如下:
1)可以在失效状态,卫星导航测量高度存在较大噪声且滞后严重的条件下直接测量高度;
2)反馈调节可以增强***鲁棒性
3)不影响飞行安全。
附图说明
图1为发明所述方法的实施流程图。
具体实施方式
为了使本发明的目的、技术方案及优点更加清楚明白,以下结合附图及实施例,对本发明进行进一步详细描述。应当理解,此处所描述的具体实施例仅仅用于解释本发明,并不用于限定本发明。相反,本发明涵盖任何由权利要求定义的在本发明的精髓和范围上做的替代、修改、等效方法以及方案。进一步,为了使公众对本发明有更好的了解,在下文对本发明的细节描述中,详尽描述了一些特定的细节部分。对本领域技术人员来说没有这些细节部分的描述也可以完全理解本发明。
下面结合附图和具体实施例对本发明作进一步说明,但不作为对本发明的限定。下面为本发明的举出最佳实施例:
如图1所示,本发明提供一种强风条件下四旋翼无人机高度测量方法,所述方法通过加速计提供的第一高度信息、气压高度计提供的第二高度信息、GPS接收机提供的第三高度信息和北斗接收机提供的第四高度信息,进行联邦级联滤波器构建,完成高度滤波输出,实现高度测量,所述方法包括:
S1:利用加速度计的垂向加速度信息进行积分,得到第一高度信息;
S2:利用气压高度计获取第二高度信息、GPS接收机获取第三高度信息、以及北斗接收机获取第四高度信息;
S3:将第一高度信息和第二高度信息都输入到第一子滤波器中,将第一高度信息和第三高度信息输入到第二子滤波器中,将第一高度信息和第四高度信息输入到第三子滤波器中;
S4:将各子滤波器中内容输出到主滤波器中,根据各传感器特点分配各子滤波器权重,构建联邦级联滤波器;
S5:对强风条件下四旋翼无人机高度信息进行滤波估计,输出高度滤波;
S6:通过S5中输出的高度滤波,对各传感器输入进行故障检测。,S1中所述利用加速度计的垂向加速度信息进行积分具体为通过垂向加速度信息进行高度积分。
S4中所述各子滤波器的滤波参数由加速度计积分高度输出方差R1、气压高度输出方差R2、GPS接收机输出方差R3、北斗接收机输出方差R4确定,其中第一子滤波器滤波参数Q阵为R1、R阵为R2,第二子滤波器滤波参数Q阵为R1、R阵为R3,第三子滤波器滤波参数Q阵为R1、R阵为R4,S1中所述的第一高度信息为具有高频响应特性的高度信息,S4中所述根据各传感器特点分配各子滤波器权重,S4中所述根据各传感器特点分配各子滤波器权重,其中第一子滤波器输出为A1,第二滤波器输出为A2,第三滤波器输出为A3,主滤波器输出为A,构建联邦级联滤波器具体为
S6中所述故障检测方法为若偏差超过阈值则实时隔离故障传感器。
本发明利用机载传感器,包括加速度计、气压高度计、GPS接收机、北斗接收机,构建联邦级联滤波器,进行强风条件下四旋翼无人机高度测量。
根据主滤波器输出反馈对各传感器进行故障检测,实时隔离故障器件,增强***鲁棒性,保证飞行安全。
实施步骤入如下:
1、利用加速度计的垂向加速度信息进行积分,得到具有高频响应特性的高度信息;
2、利用积分高度分别与气压高度,GPS接收机定位高度、北斗接收机定位高度信息三种观测量构成子滤波器,子滤波器滤波参数由加速度计、气压高度、GPS接收机、北斗接收机统计输出方差确定;
3、将各子滤波器输出作为主滤波器输入,根据各传感器特点分配各子滤波器权重,构建联邦级联滤波器,对强风条件下四旋翼无人机高度信息进行滤波估计。
4、通过主滤波器的高度输出,对各传感器输入进行故障检测,若偏差超过阈值则实时隔离故障传感器,增加***可靠性。
以上所述的实施例,只是本发明较优选的具体实施方式的一种,本领域的技术人员在本发明技术方案范围内进行的通常变化和替换都应包含在本发明的保护范围内。
Claims (7)
1.一种强风条件下四旋翼无人机高度测量方法,其特征在于,所述方法通过加速计提供的第一高度信息、气压高度计提供的第二高度信息、GPS接收机提供的第三高度信息和北斗接收机提供的第四高度信息,进行联邦级联滤波器构建,完成高度滤波输出,实现高度测量。
2.根据权利要求1所述的方法,其特征在于,所述方法包括:
S1:利用加速度计的垂向加速度信息进行积分,得到第一高度信息;
S2:利用气压高度计获取第二高度信息、GPS接收机获取第三高度信息、以及北斗接收机获取第四高度信息;
S3:将第一高度信息和第二高度信息都输入到第一子滤波器中,将第一高度信息和第三高度信息输入到第二子滤波器中,将第一高度信息和第四高度信息输入到第三子滤波器中;
S4:将各子滤波器中内容输出到主滤波器中,根据各传感器特点分配各子滤波器权重,构建联邦级联滤波器;
S5:对强风条件下四旋翼无人机高度信息进行滤波估计,输出高度滤波;
S6:通过S5中输出的高度滤波,对各传感器输入进行故障检测。
3.根据权利要求2所述的方法,其特征在于,S1中所述利用加速度计的垂向加速度信息进行积分具体为通过垂向加速度信息进行高度积分。
4.根据权利要求2所述的方法,其特征在于,S4中所述各子滤波器的滤波参数由加速度计积分高度输出方差R1、气压高度输出方差R2、GPS接收机输出方差R3、北斗接收机输出方差R4确定,其中第一子滤波器滤波参数Q阵为R1、R阵为R2,第二子滤波器滤波参数Q阵为R1、R阵为R3,第三子滤波器滤波参数Q阵为R1、R阵为R4。
5.根据权利要求2所述的方法,其特征在于,S1中所述的第一高度信息为具有高频响应特性的高度信息。
6.根据权利要求2所述的方法,其特征在于,S4中所述根据各传感器特点分配各子滤波器权重,S4中所述根据各传感器特点分配各子滤波器权重,其中第一子滤波器输出为A1,第二滤波器输出为A2,第三滤波器输出为A3,主滤波器输出为A,构建联邦级联滤波器具体为
7.根据权利要求2所述的方法,其特征在于,S6中所述故障检测方法为若偏差超过阈值则实时隔离故障传感器。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201611255899.7A CN106595577B (zh) | 2016-12-29 | 2016-12-29 | 一种强风条件下四旋翼无人机高度测量方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201611255899.7A CN106595577B (zh) | 2016-12-29 | 2016-12-29 | 一种强风条件下四旋翼无人机高度测量方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106595577A true CN106595577A (zh) | 2017-04-26 |
CN106595577B CN106595577B (zh) | 2019-12-31 |
Family
ID=58581443
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201611255899.7A Active CN106595577B (zh) | 2016-12-29 | 2016-12-29 | 一种强风条件下四旋翼无人机高度测量方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106595577B (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111811472A (zh) * | 2020-07-01 | 2020-10-23 | 亿航智能设备(广州)有限公司 | 一种气压计高度动态补偿方法、装置、计算机存储介质 |
CN112629482A (zh) * | 2019-09-24 | 2021-04-09 | 华为技术有限公司 | 一种在飞机上测量高度的方法及设备 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102360218A (zh) * | 2011-10-14 | 2012-02-22 | 天津大学 | 基于arm和fpga的无人直升机导航与飞行控制*** |
CN202423959U (zh) * | 2012-02-24 | 2012-09-05 | 山东电力研究院 | 四旋翼无人机输电线路杆塔智能巡检*** |
CN104460685A (zh) * | 2014-11-21 | 2015-03-25 | 南京信息工程大学 | 一种四旋翼飞行器的控制***及其控制方法 |
CN106094860A (zh) * | 2016-08-29 | 2016-11-09 | 广西师范大学 | 四旋翼飞行器及其控制方法 |
-
2016
- 2016-12-29 CN CN201611255899.7A patent/CN106595577B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102360218A (zh) * | 2011-10-14 | 2012-02-22 | 天津大学 | 基于arm和fpga的无人直升机导航与飞行控制*** |
CN202423959U (zh) * | 2012-02-24 | 2012-09-05 | 山东电力研究院 | 四旋翼无人机输电线路杆塔智能巡检*** |
CN104460685A (zh) * | 2014-11-21 | 2015-03-25 | 南京信息工程大学 | 一种四旋翼飞行器的控制***及其控制方法 |
CN106094860A (zh) * | 2016-08-29 | 2016-11-09 | 广西师范大学 | 四旋翼飞行器及其控制方法 |
Non-Patent Citations (2)
Title |
---|
HU YONG: ""Federated Filter Based Multi-Sensor Fault-tolerant Altitude Determination System for UAV"", 《2008 CHINESE CONTROL AND DECISION CONFERENCE》 * |
陈曦: ""基于惯性/卫星/雷达高度计的靶用型无人机海面低空飞行容错导航技术"", 《中国优秀硕士学位论文全文数据库》 * |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112629482A (zh) * | 2019-09-24 | 2021-04-09 | 华为技术有限公司 | 一种在飞机上测量高度的方法及设备 |
CN111811472A (zh) * | 2020-07-01 | 2020-10-23 | 亿航智能设备(广州)有限公司 | 一种气压计高度动态补偿方法、装置、计算机存储介质 |
Also Published As
Publication number | Publication date |
---|---|
CN106595577B (zh) | 2019-12-31 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103791916B (zh) | 一种基于mems惯导的组合车载导航*** | |
TW518422B (en) | Positioning and proximity warning method and system thereof for vehicle | |
CN103869822B (zh) | 多旋翼无人机感知与规避***及其规避方法 | |
US6157891A (en) | Positioning and ground proximity warning method and system thereof for vehicle | |
US8600660B2 (en) | Multipath modeling for deep integration | |
CN106767787A (zh) | 一种紧耦合gnss/ins组合导航装置 | |
US6493631B1 (en) | Geophysical inertial navigation system | |
CN102176041B (zh) | 一种基于gnss/sins组合的车辆导航监控*** | |
CN105606094B (zh) | 一种基于mems/gps组合***的信息条件匹配滤波估计方法 | |
EP2023083A2 (en) | System and method for high accuracy relative navigation | |
JP2017021021A (ja) | モバイルコンピュータ大気圧システム | |
CN104880189A (zh) | 一种动中通天线低成本跟踪抗干扰方法 | |
CN106403940B (zh) | 一种抗大气参数漂移的无人机飞行导航***高度信息融合方法 | |
DE102010060234A1 (de) | Verfahren und Applikationen zur Höhenmessung und der Vereinigung von Benutzerinhaltserfassung mit einer Elevationsbewegung für persönliche Navigationssysteme | |
CN105242682B (zh) | 靶机目标特性测量*** | |
CN103487052A (zh) | 一种基于磁传感器组合的飞行器姿态测量方法 | |
CN107274721A (zh) | 一种智能交通***中多车辆协作定位方法 | |
Amin et al. | Kalman filtered GPS accelerometer-based accident detection and location system: A low-cost approach | |
Suwandi et al. | Low-cost IMU and GPS fusion strategy for apron vehicle positioning | |
US6845304B1 (en) | Method of and system for deriving inertial-aided deviations for autoland systems during GPS signal interruptions | |
CN106595577A (zh) | 一种强风条件下四旋翼无人机高度测量方法 | |
CN106403938A (zh) | 一种针对小型无人机多源复合振动干扰的***滤波方法 | |
CN111638514A (zh) | 无人机测高方法及无人机导航滤波器 | |
RU109553U1 (ru) | Интегрированная система на основе бесплатформенной инерциальной навигационной системы и спутниковой навигационной системы | |
García et al. | Analysis of sensor data and estimation output with configurable UAV platforms |
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 |