CN106403940B - 一种抗大气参数漂移的无人机飞行导航系统高度信息融合方法 - Google Patents
一种抗大气参数漂移的无人机飞行导航系统高度信息融合方法 Download PDFInfo
- Publication number
- CN106403940B CN106403940B CN201610740929.7A CN201610740929A CN106403940B CN 106403940 B CN106403940 B CN 106403940B CN 201610740929 A CN201610740929 A CN 201610740929A CN 106403940 B CN106403940 B CN 106403940B
- Authority
- CN
- China
- Prior art keywords
- unmanned plane
- altitude
- pressure
- baroceptor
- height
- 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
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
Abstract
本发明涉及一种适用于无人机飞行导航系统的抗大气参数漂移的高度信息融合方法,利用基站气压设备和机上气压传感器实时计算差分高度量测量,以抑制大气物理环境带来的漂移;使用加计辅助气压高度的CF+气压高度辅助加计的KF双滤波器实现高度通道的信息融合,改善气压高度的延迟问题,实现自适应无人机动态特性的高度通道的较优融合。本发明适用于低成本气压高度传感器和MEMS IMU的无人机飞行导航系统的高度通道估计。
Description
技术领域
本发明涉及一种抗大气参数漂移的无人机飞行导航系统高度信息融合方法,适用于低成本气压高度传感器和MEMS IMU的无人机飞行导航系统的高度通道估计。
背景技术
微小型无人机采用MEMS级别的IMU及低成本的气压高度计等作为测量传感器。IMU包含加速度、陀螺仪等传感器,与磁罗盘可构成无人机系统的AHRS系统,为无人机提供可靠的姿态信息。导航系统准确的高度、速度估计结果为无人机的高度控制提供有力的保障。微小型无人机系统集成的高度通道测量传感器受体积、质量、成本的影响,存在着漂移、延迟、随机噪声大等问题。本发明针对传统的气压高度传感器存在的问题,提出了一种利用差分气压高度观测量抗大气参数漂移的高度信息融合方法。
传统的高度通道估计一般采用多传感器、单一融合方法进行信息融合,无法民气压高度计的大气漂移及延迟等问题。
发明内容
本发明的技术解决问题是:克服传统低成本气压高度计的漂移、延迟等问题,提供一种抗大气参数漂移的无人机飞行导航系统高度信息融合方法,在多传感器信息融合的基础上,采用互补滤波器及卡尔曼滤波器双滤波器,根据无人机的运动特性自适应分配双滤波器的权重,充分发挥两种滤波器各自的优势,具有更好的可靠性,为无人机高度通道提供较优的高度、速度估计。
本发明的技术解决方案为:一种抗大气参数漂移的无人机飞行导航系统高度信息融合方法,采用基站气压传感器及机上气压传感器构建气压高度差分观测量,抑制气压高度传感器的大气环境漂移误差;使用惯性测量单元IMU及磁传感器构成的AHRS(Attitudeand Heading Reference System,航姿参考系统)进行姿态更新,获得机上加速度在导航系统的天向加速度分量,同时与气压高度差分量测量进行信息融合,获得高度通道的高度、速度估计值;使用加计辅助气压高度的互补滤波器CF(Complementary Filter)+气压高度辅助加计的卡尔曼滤波器KF(Kalman Filter)构成的双滤波器实现高度通道的信息融合,实现自适应无人机动态特性的较优融合。
具体包括以下步骤:
(1)采用基站气压传感器与机上气压传感器构造气压差分观测量。基站气压传感器安装在地面系统中,保持静止状态。基站与机上气压传感器在小于5公里的飞行范围内的大气漂移量近乎相同,大气漂移为缓变量,故基站气压传感器经过预处理后以1HZ的频率发送到机上处理器,与机上气压传感器构造气压差分量测量以减小气压高度的漂移误差。惯性测量单元IMU为MEMS(Micro-electromechanical Systems)工艺惯性测量单元,满足小型无人机机载电子设备低功耗、小体积、轻质量的限制。
(2)无人机的天向加速度由载体系的加速度通过阵分解得到。阵则由IMU及磁传感器组成的AHRS系统实时更新的姿态信息计算得到。
(3)子滤波器1(CF)为加计辅助气压高度的互补滤波器,利用加速度计算高度与气压高度量测量噪声的互补特性实现高度信息估计。加速度计算高度噪声具有低频统计特性,气压高度量测量具有高频统计特性,采用互补滤波器进行信息融合得到较为平滑的估计结果。
(4)子滤波器2(KF)为气压高度辅助加速度的卡尔曼滤波器,具有较好的动态响应。子滤波器2分为动态递推和滤波更新两个过程。在非滤波时刻利用加速度与高度的动力学方程对高度通道的状态量进行递推解算,在滤波时刻利用气压高度量测量校正高度估计的状态量。子滤波器2具有较好的动态响应,利用加速度与高度的动力学方程在非滤波时刻对高度通道的状态量进行递推解算,滤波时刻利用气压高度量测量校正高度估计的状态量。
(5)在每个计算周期,均采取加计辅助气压高度的互补滤波器+气压高度辅助加计的卡尔曼滤波器双滤波器进行滤波更新,根据无人机的运动特性自适应分配双滤波器的权重,进行高度通道的信息融合。
(6)使用加计辅助气压高度的互补滤波器CF+气压高度辅助加计的卡尔曼滤波器KF构成的双滤波器实现高度通道的信息融合时,根据无人机的运动特性自适应分配双滤波器的权重,进行信息融合;当无人机处于运动状态时,因互补滤波器CF的高度、速度估计结果受气压高度延迟影响,故加大卡尔曼滤波器KF的融合权重,提高整个滤波器的动态响应能力;当无人机处于静止或平稳运动状态时,互补滤波器CF的高度、速度估计结果的平滑性优于卡尔曼滤波器KF,加大互补滤波器的融合权重。
(7)当天向加速度的均值、方差以及速度均小于相应的门限值时,则判断无人机在高度方向上处于静止或平稳运动状态,加大互补滤波器的权重,获得更平滑的滤波结果;反之则判断无人机在高度方向上有机动运动,处于运动状态,加大卡尔曼滤波器的权重,获得更好的动态特性。
(8)传感器量测数据更新,上述步骤重复计算。
本发明的原理是:气压高度传感器为高度状态量的估计提供直接观测量,采用气压差分观测量抑制高度观测量的大气漂移误差。利用机上的IMU及磁传感器组成的AHRS系统,计算天向加速度观测量,实现多传感器在高度通道上的信息融合。使用互补滤波器/卡尔曼滤波器双滤波器的信息融合方法,根据无人机的运动特性自适应分配双滤波器的权重,充分发挥两种滤波器各自最大的优势,得到无人机高度、速度的较优估计。
本发明与现有技术相比的优点在于:
(1)本发明针对微小型无人机的低成本气压高度量测量存在的漂移、延迟、随机噪声大等问题,提出了一种抗大气参数漂移的信息融合方法。采用基站与机上气压计的差分量作为子滤波器的观测量抑制大气参数的漂移误差。相对于传统的高度通道信息融合技术,本发明采用多传感器、多融合方法进行高度通道的信息融合。用互补滤波器及卡尔曼滤波器双滤波器,根据无人机的运动特性自适应分配双滤波器的权重,充分发挥两种滤波器各自的优势,具有更好的可靠性,为无人机高度通道提供较优的高度、速度估计。
(2)本发明以低成本气压高度计和MEMS IMU等为测量传感器,采用基站与机上的气压差分观测量,以互补滤波器和卡尔曼滤波器双滤波器进行信息融合,改善气压高度计的大气漂移及延迟等问题,为无人机提供较优的高度、速度估计值。本发明适用于低成本气压高度传感器和MEMS IMU的无人机飞行导航系统的高度通道估计。
附图说明
图1为本发明的抗大气参数漂移的无人机飞行导航系统高度信息融合方法流程图。
具体实施方式
如图1所示,本发明的具体方法如下:
(1)基站气压传感器经过预处理后以一定的频率发送到机上处理器,与机上气压传感器构造气压差分量测量hdiff=hd-hb。hd为机上气压测量值,hb为基站气压测量值,hdiff为气压差分量测量。
(2)选择东北天坐标系为无人机的导航坐标系,由机上的IMU及磁传感器组成的AHRS系统得到姿态角(φθψ),φ、θ、ψ分别为滚转、俯仰和航向姿态角,计算方向余弦矩阵由方向余弦矩阵将机体系下的加速度转换到导航系下,获得天向加速度观测量aU。分别为机体系下的加速度,aE、aN、aU分别东、北、天向加速度。
(3)将步骤(1)、(2)计算得到的气压差分观测量hdiff和天向加速度aU送入子滤波器1(加计辅助气压高度的互补滤波器)和子滤波器2(气压高度辅助加计的卡尔曼滤波器)进行滤波估计分别得到k时刻子滤波器1和子滤波器2的高度、速度估计值和
(4)子滤波器1的计算方法如下,由天向加速度aU对前一滤波时刻得到的高度、速度估计进行状态更新得利用气压高度与状态更新的高度作为误差校正量闭环校正高度、速度估计。得到子滤波器1的高度、速度估计量
(5)子滤波器2的计算方法如下,在非滤波时刻t时刻,由天向加速度aU对前一时刻的高度、速度估计进行状态更新。达到滤波时刻k时刻,利用气压高度观测量作为高度量测量对子滤波器2进行量测更新获得子滤波器2的高度、速度估计子滤波器2在非滤波时刻充分信赖加速度传感器的数据,具有较好的动态响应能力。
(6)对子滤波器1和子滤波器2的高度、速度估计值和进行信息融合,融合权重分别为β1和β2。β1和β2均小于1,且β1+β2=1。当β1>β2时,对CF滤波器信赖的权重更大;当β1<β2时,对KF滤波器信赖的权重更大。
(7)根据无人机当前的运动特性自适应分配双滤波器的融合权重β1、β2,β1+β2=1。当1s内天向加速度的均值am、方差astd以及天向速度vu均小于相应的门限值时,则判断无人机在高度方向上处于静止或平稳运动状态。天向加速度的均值门限可取0.2m/s2,加速度方差门限值与加速度传感器的噪声统计特性有关,对于RMS为的MEMS加速度传感器,阈值可取0.05,速度门限可取2-5m/s。
当无人机处于静止或平稳运动状态,此时应加大互补滤波器的权重,β1>β2,获得更平滑的滤波结果。当无人机在高度方向上有机动运动,处于运动状态,则加大卡尔曼滤波器的权重,β1<β2,获得更好的动态特性。具体的权重计算公式由上述阈值可设计如下所示。
(8)在测量值更新时迭代重复上述过程。
总之,本发明使用加计辅助气压高度的CF+气压高度辅助加计的KF双滤波器实现高度通道的信息融合,改善气压高度的延迟问题,实现自适应无人机动态特性的高度通道的较优融合。本发明适用于低成本气压高度传感器和MEMS IMU的无人机飞行导航系统的高度通道估计。
本发明说明书中未作详细描述的内容属于本领域专业技术人员公知的现有技术。
提供以上实施例仅仅是为了描述本发明的目的,而并非要限制本发明的范围。本发明的范围由所附权利要求限定。不脱离本发明的精神和原理而做出的各种等同替换和修改,均应涵盖在本发明的范围之内。
Claims (4)
1.一种抗大气参数漂移的无人机飞行导航系统高度信息融合方法,其特征在于:采用基站气压传感器及机上气压传感器构建气压高度差分观测量,抑制气压高度传感器的大气环境漂移误差;使用惯性测量单元IMU及磁传感器构成的AHRS(Attitude and HeadingReference System,航姿参考系统)进行姿态更新,获得机上加速度在导航系的天向加速度分量,同时与气压高度差分量测量进行信息融合,获得高度通道的高度、速度估计值;使用加计辅助气压高度的互补滤波器CF+气压高度辅助加计的卡尔曼滤波器KF构成的双滤波器实现高度通道的信息融合,实现自适应无人机动态特性的较优融合;
采用基站气压传感器及机上气压传感器构建气压高度差分观测量时,基站气压传感器与机上气压传感器在小于5公里的飞行范围内的大气漂移量近乎相同,故将基站气压传感器经过预处理后以1HZ的频率发送到无人机的机上处理器,从而与机上气压传感器构造气压差分量测量可以减小气压高度的漂移误差;
所述互补滤波器CF作为子滤波器1,利用加速度计算高度与气压高度量测量噪声的互补特性实现高度信息估计;
所述卡尔曼滤波器KF作为子滤波器2,子滤波器2分为动态递推和滤波更新两个过程,在非滤波时刻利用加速度与高度的动力学方程对高度通道的状态量进行递推解算,在滤波时刻利用气压高度量测量校正高度估计的状态量;
使用加计辅助气压高度的互补滤波器CF+气压高度辅助加计的卡尔曼滤波器KF构成的双滤波器实现高度通道的信息融合时,根据无人机的运动特性自适应分配双滤波器的权重,进行信息融合;当无人机处于运动状态时,加大卡尔曼滤波器KF的融合权重,提高整个滤波器的动态响应能力;当无人机处于静止或平稳运动状态时,互补滤波器CF的高度、速度估计结果的平滑性优于卡尔曼滤波器KF,加大互补滤波器的融合权重。
2.根据权利要求1所述一种抗大气参数漂移的无人机飞行导航系统高度信息融合方法,其特征在于:所述基站气压传感器及机上气压传感器为低成本气压传感器;所述惯性测量单元IMU为MEMS工艺惯性测量单元;满足小型无人机机载电子设备低功耗、小体积、轻质量的限制。
3.根据权利要求1所述一种抗大气参数漂移的无人机飞行导航系统高度信息融合方法,其特征在于:使用惯性测量单元IMU及磁传感器构成的AHRS(Attitude and HeadingReference System,航姿参考系统)进行姿态更新时,首先通过AHRS获得姿态信息,由姿态信息计算方向余弦矩阵再由余弦矩阵计算加速度在导航系的天向加速度分量。
4.根据权利要求1所述一种抗大气参数漂移的无人机飞行导航系统高度信息融合方法,其特征在于:所述无人机处于运动状态、静止或平稳运动状态判断方法为:无人机在高度方向上的运动特性由天向加速度、天向速度共同决定,当天向加速度的均值、方差以及速度均小于相应的门限值时,则判断无人机处于静止或平稳运动状态中,反之则判断无人机在高度方向上处于运动状态。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610740929.7A CN106403940B (zh) | 2016-08-26 | 2016-08-26 | 一种抗大气参数漂移的无人机飞行导航系统高度信息融合方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610740929.7A CN106403940B (zh) | 2016-08-26 | 2016-08-26 | 一种抗大气参数漂移的无人机飞行导航系统高度信息融合方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106403940A CN106403940A (zh) | 2017-02-15 |
CN106403940B true CN106403940B (zh) | 2018-10-19 |
Family
ID=58002294
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610740929.7A Active CN106403940B (zh) | 2016-08-26 | 2016-08-26 | 一种抗大气参数漂移的无人机飞行导航系统高度信息融合方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106403940B (zh) |
Families Citing this family (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
TWI610085B (zh) * | 2017-03-15 | 2018-01-01 | 酷異有限公司 | 三維定位裝置與方法 |
US11573089B2 (en) * | 2018-05-28 | 2023-02-07 | Here Global B.V. | Multilevel altitude maps |
WO2020019331A1 (zh) * | 2018-07-27 | 2020-01-30 | 深圳市大疆创新科技有限公司 | 气压计的高度测量补偿方法以及无人机 |
EP3640600B1 (en) | 2018-10-16 | 2023-03-29 | Infineon Technologies AG | Device and method for self-correcting a sensed physical parameter in a drone or unmanned aerial vehicle |
CN110658831B (zh) * | 2019-10-22 | 2022-04-15 | 深圳市道通智能航空技术股份有限公司 | 对地高度校正方法及装置、无人飞行器 |
CN111006659A (zh) * | 2019-12-06 | 2020-04-14 | 江西洪都航空工业集团有限责任公司 | 一种具备多导航源信息融合功能的导航系统 |
CN112066985B (zh) * | 2020-09-22 | 2022-08-09 | 峰飞航空科技(昆山)有限公司 | 一种组合导航系统初始化方法、装置、介质及电子设备 |
CN112650281B (zh) * | 2020-12-14 | 2023-08-22 | 一飞(海南)科技有限公司 | 多传感器三余度系统、控制方法、无人机、介质及终端 |
CN113778120A (zh) * | 2021-10-27 | 2021-12-10 | 北京航空航天大学 | 一种多传感器融合的无人机复杂天候飞行控制方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH08327375A (ja) * | 1995-06-02 | 1996-12-13 | Sony Corp | 景色表示システム |
CN102023000A (zh) * | 2010-09-30 | 2011-04-20 | 清华大学 | 无人直升机气压高度计和gps融合测高方法 |
CN103512584A (zh) * | 2012-06-26 | 2014-01-15 | 北京赛佰特科技有限公司 | 导航姿态信息输出方法、装置及捷联航姿参考系统 |
CN103697889A (zh) * | 2013-12-29 | 2014-04-02 | 北京航空航天大学 | 一种基于多模型分布式滤波的无人机自主导航与定位方法 |
CN104567799A (zh) * | 2014-11-28 | 2015-04-29 | 天津大学 | 基于多传感器信息融合的小型旋翼无人机高度测量方法 |
-
2016
- 2016-08-26 CN CN201610740929.7A patent/CN106403940B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH08327375A (ja) * | 1995-06-02 | 1996-12-13 | Sony Corp | 景色表示システム |
CN102023000A (zh) * | 2010-09-30 | 2011-04-20 | 清华大学 | 无人直升机气压高度计和gps融合测高方法 |
CN103512584A (zh) * | 2012-06-26 | 2014-01-15 | 北京赛佰特科技有限公司 | 导航姿态信息输出方法、装置及捷联航姿参考系统 |
CN103697889A (zh) * | 2013-12-29 | 2014-04-02 | 北京航空航天大学 | 一种基于多模型分布式滤波的无人机自主导航与定位方法 |
CN104567799A (zh) * | 2014-11-28 | 2015-04-29 | 天津大学 | 基于多传感器信息融合的小型旋翼无人机高度测量方法 |
Also Published As
Publication number | Publication date |
---|---|
CN106403940A (zh) | 2017-02-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106403940B (zh) | 一种抗大气参数漂移的无人机飞行导航系统高度信息融合方法 | |
CN109911188B (zh) | 非卫星导航定位环境的桥梁检测无人机系统 | |
CN107588769B (zh) | 一种车载捷联惯导、里程计及高程计组合导航方法 | |
CN108152529A (zh) | 一种基于飞行参数计算风速及风向的方法 | |
CN110081878B (zh) | 一种多旋翼无人机的姿态及位置确定方法 | |
CN105723240B (zh) | 用加速度/减速度确定设备和船只间的错位的方法和装置 | |
CN205540288U (zh) | 一种具有多功能地面站的无人机系统 | |
CN104374388B (zh) | 一种基于偏振光传感器的航姿测定方法 | |
CN102175882B (zh) | 基于自然地标的无人直升机视觉测速方法 | |
CN111426320B (zh) | 一种基于图像匹配/惯导/里程计的车辆自主导航方法 | |
CN113819914A (zh) | 一种地图构建方法及装置 | |
CN103697889A (zh) | 一种基于多模型分布式滤波的无人机自主导航与定位方法 | |
CN102353377A (zh) | 一种高空长航时无人机组合导航系统及其导航定位方法 | |
CN112066985B (zh) | 一种组合导航系统初始化方法、装置、介质及电子设备 | |
KR101239864B1 (ko) | 다중 센서를 이용한 항법시스템 및 그 제공방법 | |
CN103453907B (zh) | 基于分层大气模型的行星进入段导航滤波方法 | |
CN103712598A (zh) | 一种小型无人机姿态确定系统与确定方法 | |
KR20160068260A (ko) | 실내환경에서의 쿼드로터형 무인비행체의 자세 안정화 및 고도 제어 | |
CN109827580A (zh) | 一种汽车姿态数据采集系统 | |
RU2564379C1 (ru) | Бесплатформенная инерциальная курсовертикаль | |
CN110007318B (zh) | 风场干扰下基于卡尔曼滤波的单无人机判断gps欺骗的方法 | |
CN109143303B (zh) | 飞行定位方法、装置及固定翼无人机 | |
WO2023009200A3 (en) | System and method for tethered unmanned aerial vehicle takeoff, landing, and storage | |
Wang et al. | Monocular vision and IMU based navigation for a small unmanned helicopter | |
CN109541963B (zh) | 一种基于侧滑角信息的无人机测风建模方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |