CN106595577B - 一种强风条件下四旋翼无人机高度测量方法 - Google Patents

一种强风条件下四旋翼无人机高度测量方法 Download PDF

Info

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
Application number
CN201611255899.7A
Other languages
English (en)
Other versions
CN106595577A (zh
Inventor
倪书豪
姜梁
王富贵
于翔海
龚晶
郭庆
徐发洋
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Electronic Technology Research Institute Of China Aerospace
Original Assignee
Electronic Technology Research Institute Of China Aerospace
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Electronic Technology Research Institute Of China Aerospace filed Critical Electronic Technology Research Institute Of China Aerospace
Priority to CN201611255899.7A priority Critical patent/CN106595577B/zh
Publication of CN106595577A publication Critical patent/CN106595577A/zh
Application granted granted Critical
Publication of CN106595577B publication Critical patent/CN106595577B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

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中所述故障检测方法为若偏差超过阈值则实时隔离故障传感器。
CN201611255899.7A 2016-12-29 2016-12-29 一种强风条件下四旋翼无人机高度测量方法 Active CN106595577B (zh)

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)

* Cited by examiner, † Cited by third party
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)

* Cited by examiner, † Cited by third party
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 广西师范大学 四旋翼飞行器及其控制方法

Patent Citations (4)

* Cited by examiner, † Cited by third party
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
CN109443342A (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
CN110632553A (zh) 定位方法、装置、系统、计算机可读存储介质及无人机
Maeder et al. Trajectory prediction for light aircraft
CN105242682A (zh) 靶机目标特性测量系统
Wei et al. Altitude data fusion utilising differential measurement and complementary filter
CN109725649A (zh) 一种基于气压计/imu/gps多传感器融合的旋翼无人机定高算法
CN107577238B (zh) 基于ukf的无人机气压计异常数据处理的高度控制方法
Mostafa et al. GPS/DVL/MEMS‐INS smartphone sensors integrated method to enhance USV navigation system based on adaptive DSFCF
Chen et al. Attacking altitude estimation in drone navigation
CN111338215B (zh) 一种基于惯性回路的双滤波器扰动观测器方法
CN110082805A (zh) 一种三维定位装置和方法
Kuznetsov et al. Development of MEMS sensors for aircraft control systems
CN114199220A (zh) 一种无人机空中在线磁罗盘校准方法和装置
CN111880576B (zh) 基于视觉的无人机飞行控制方法及装置
Lei et al. Multi-sensor integrated navigation algorithm using adaptive federated Kalman filter for MAVs
US11046451B1 (en) Angle of attack estimation system and method

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