CN106595577B - 一种强风条件下四旋翼无人机高度测量方法 - Google Patents
一种强风条件下四旋翼无人机高度测量方法 Download PDFInfo
- Publication number
- CN106595577B CN106595577B CN201611255899.7A CN201611255899A CN106595577B CN 106595577 B CN106595577 B CN 106595577B CN 201611255899 A CN201611255899 A CN 201611255899A CN 106595577 B CN106595577 B CN 106595577B
- Authority
- CN
- China
- Prior art keywords
- filter
- height
- sub
- height information
- information
- 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.)
- Active
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 (4)
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。
2.根据权利要求1所述的方法,其特征在于,S1中所述的第一高度信息为具有高频响应特性的高度信息。
3.根据权利要求1所述的方法,其特征在于,S4中所述根据各传感器特点分配各子滤波器权重,S4中所述根据各传感器特点分配各子滤波器权重,其中第一子滤波器输出为A1,第二子滤波器输出为A2,第三子滤波器输出为A3,主滤波器输出为A,构建联邦级联滤波器具体为
4.根据权利要求1所述的方法,其特征在于,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 CN106595577A (zh) | 2017-04-26 |
CN106595577B true 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) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112629482A (zh) * | 2019-09-24 | 2021-04-09 | 华为技术有限公司 | 一种在飞机上测量高度的方法及设备 |
CN111811472B (zh) * | 2020-07-01 | 2022-03-29 | 亿航智能设备(广州)有限公司 | 一种气压计高度动态补偿方法、装置、计算机存储介质 |
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 | 广西师范大学 | 四旋翼飞行器及其控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN106595577A (zh) | 2017-04-26 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP6202151B2 (ja) | モバイルコンピュータ大気圧システム | |
EP3267152B1 (en) | Navigation aids for unmanned aerial systems in a gps-denied environment | |
CN104567799B (zh) | 基于多传感器信息融合的小型旋翼无人机高度测量方法 | |
Yu | INS/GPS integration system using adaptive filter for estimating measurement noise variance | |
CN109900300B (zh) | 一种用于无人机的组合导航完好性监测*** | |
US8543281B2 (en) | Method and system for estimating the angular speed of a mobile | |
CN106767787A (zh) | 一种紧耦合gnss/ins组合导航装置 | |
Zhou et al. | Integrated navigation system for a low-cost quadrotor aerial vehicle in the presence of rotor influences | |
CN106681344A (zh) | 一种用于飞行器的高度控制方法及控制*** | |
RU2380656C1 (ru) | Комплексированная бесплатформенная инерциально-спутниковая система навигации на "грубых" чувствительных элементах | |
CN106595577B (zh) | 一种强风条件下四旋翼无人机高度测量方法 | |
US10908296B2 (en) | Method for calculating a speed of an aircraft, method for calculating a protection radius, positioning system and associated aircraft | |
Szafranski et al. | Altitude estimation for the UAV's applications based on sensors fusion algorithm | |
CN109443342A (zh) | 新型自适应卡尔曼无人机姿态解算方法 | |
Maeder et al. | Trajectory prediction for light aircraft | |
CN105242682A (zh) | 靶机目标特性测量*** | |
CN104880189A (zh) | 一种动中通天线低成本跟踪抗干扰方法 | |
Wei et al. | Altitude data fusion utilising differential measurement and complementary filter | |
US10353079B2 (en) | Precise positioning method | |
Mostafa et al. | GPS/DVL/MEMS‐INS smartphone sensors integrated method to enhance USV navigation system based on adaptive DSFCF | |
CN109725649A (zh) | 一种基于气压计/imu/gps多传感器融合的旋翼无人机定高算法 | |
Chen et al. | Attacking altitude estimation in drone navigation | |
CN111338215B (zh) | 一种基于惯性回路的双滤波器扰动观测器方法 | |
CN105466423A (zh) | 一种无人机导航***及其运行方法 | |
Kuznetsov et al. | Development of MEMS sensors for aircraft control 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 | ||
GR01 | Patent grant | ||
GR01 | Patent grant |