CN112815937A - 一种冗余惯性测量单元数据融合最优权重估计方法 - Google Patents

一种冗余惯性测量单元数据融合最优权重估计方法 Download PDF

Info

Publication number
CN112815937A
CN112815937A CN202011623560.4A CN202011623560A CN112815937A CN 112815937 A CN112815937 A CN 112815937A CN 202011623560 A CN202011623560 A CN 202011623560A CN 112815937 A CN112815937 A CN 112815937A
Authority
CN
China
Prior art keywords
gyroscope
accelerometer
optimal
taste
data
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
Application number
CN202011623560.4A
Other languages
English (en)
Other versions
CN112815937B (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.)
Peoples Liberation Army Strategic Support Force Aerospace Engineering University
Original Assignee
Peoples Liberation Army Strategic Support Force Aerospace Engineering University
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 Peoples Liberation Army Strategic Support Force Aerospace Engineering University filed Critical Peoples Liberation Army Strategic Support Force Aerospace Engineering University
Priority to CN202011623560.4A priority Critical patent/CN112815937B/zh
Publication of CN112815937A publication Critical patent/CN112815937A/zh
Application granted granted Critical
Publication of CN112815937B publication Critical patent/CN112815937B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/10Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
    • G01C21/12Navigation; 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/16Navigation; 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
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/20Instruments for performing navigational calculations
    • YGENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02TCLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
    • Y02T90/00Enabling technologies or technologies with a potential or indirect contribution to GHG emissions mitigation

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Automation & Control Theory (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Gyroscopes (AREA)

Abstract

本发明涉及一种冗余惯性测量单元数据融合最优权重估计方法。将惯性测量单元先后六个面朝上放置于大理石平台上,采集各个位置陀螺仪和加速度计数据。利用加权最小二乘法对陀螺仪和加速度计数据进行数据融合将其转换为惯性测量单元坐标系下等效三轴的测量信息,并根据大理石平台天向角速率和加速度恒定的特点,构建关于加权最小二乘权重的非线性方程组。设计约束型果蝇优化算法估计非线性方程组的最小二范数,得到陀螺仪和加速度计加权最小二乘的最优权重。该发明可对冗余惯性测量单元数据融合最优权重进行估计,利用此权重进行数据融合可有效提高冗余惯性测量单元测量精度。本发明属于惯性导航技术领域,可应用于冗余惯性测量单元数据融合。

Description

一种冗余惯性测量单元数据融合最优权重估计方法
技术领域
本发明涉及一种冗余惯性测量单元数据融合最优权重估计方法,适用于冗余惯性测量单元数据融合的场合。
技术背景
惯性导航是各类运载体实现自主导航的核心技术,因此惯性导航系统的导航精度和可靠性直接影响了运载体的导航性能。在惯性导航技术发展初期,人们就意识到对惯性传感器进行冗余配置的重要性。然而,早期惯性导航冗余的目的主要是提高系统的可靠性。随着冗余惯性测量单元(Redundant Inertial Measurement Unit,RIMU)研究的不断深入以及数据处理技术的发展,越来越多的研究人员试图利用惯性器件的冗余信息进行数据融合以提升其导航精度。
RIMU数据融合在工程上一般采用最简单的最小二乘法,其算法简单且稳定可靠。然而,最小二乘法不分优劣地使用了所有传感器地测量值,因此其测量精度并不高。为了进一步提高RIMU的测量精度,研究人员普遍采用加权最小二乘法进行冗余传感器的数据融合,因此,加权最小二乘法权重的选择成为了新的研究方向。最常用的加权最小二乘法是马尔可夫估计(也称最优加权最小二乘),马尔可夫估计采用量程噪声方差阵的逆矩阵作为权重矩阵,对于理想的高斯白噪声而言,该权重确实是最优的权重,然而实际噪声往往不是理想的高斯白噪声。此外,对于权重选择的研究,有基于零偏稳定性配置权重的,也有基于有限时间噪声方差配置权重的,但研究对象都为测量噪声。实际上,惯性传感器对测量精度的影响不仅仅是测量噪声,还包括零偏重复性、标度因数重复性等多种因素。
因此,如何在考虑多种影响因素的情况下配置合理的加权最小二乘权重成为进一步提高RIMU测量精度的新途径。
发明内容
本发明解决的技术问题是:针对RIMU在利用加权最小二乘法进行数据融合时如何配置最优权重的问题,提出了一种RIMU数据融合最优权重估计方法。本发明方法通过采集不同位置RIMU数据,并根据静止位置天向角速率和加速度恒定的特点,构建关于加权最小二乘权重的非线性方程组;设计约束型果蝇优化算法估计非线性方程组的最小二范数,以此获得RIMU数据融合的最优权重。该发明不单独考虑某个因素对测量精度的影响,而是基于不同位置激活影响测量精度的各种因素,然后根据实际测量数据估计最优权重。估计出的权重充分考虑了各种影响因素,可有效提高RIMU数据融合的测量精度。
本发明的技术解决方案:
将RIMU先后六个面朝上放置于大理石平台上,采集各个位置陀螺仪和加速度计数据,利用加权最小二乘法对陀螺仪和加速度计数据进行数据融合将其转换为RIMU坐标系下等效三轴的测量信息,并根据大理石平台天向角速率和加速度恒定的特点,构建关于加权最小二乘权重的非线性方程组。具体包括以下步骤:
(1)分别将RIMUx轴朝上、x轴朝下、y轴朝上、y轴朝下、z轴朝上和z轴朝下依次放置于大理石平台上,定义为位置1~6,在每个位置每1秒采集1组陀螺仪和加速度计数据,持续采集1分钟,分别对陀螺仪和加速度计构建各位置单组数据的非线性方程如下:
Figure BDA0002878801480000031
Figure BDA0002878801480000032
其中,
Figure BDA0002878801480000033
Figure BDA0002878801480000034
分别表示第1~6个位置第j组数据关于陀螺仪和加速度计加权最小二乘权重的非线性函数,j=1,2,...,60,Wg和Wa分别表示陀螺仪和加速度计加权最小二乘权重矩阵,Hg和Ha分别表示陀螺仪和加速度计的配置结构矩阵,ωr1j、ωr2j、ωr3j、ωr4j、ωr5j和ωr6j分别表示所有陀螺仪在第1~6个位置采集的第j组数据,ar1j、ar2j、ar3j、ar4j、ar5j和ar6j分别表示所有加速度计在第1~6个位置采集的第j组数据,|x、|y和|z分别表示取RIMU坐标系x、y和z轴数据,Ω表示地球自转角速率的大小,sin表示正弦函数,L表示当地纬度,G表示当地重力加速度大小。
(2)利用惯性测量单元各个位置采集的所有数据分别对陀螺仪和加速度计构建关于加权最小二乘权重的非线性方程组如下:
Figure BDA0002878801480000041
Figure BDA0002878801480000042
其中,Fg和Fa分别表示对陀螺仪和加速度计的关于加权最小二乘权重的非线性函数组,
Figure BDA0002878801480000043
Figure BDA0002878801480000044
分别表示第i个位置第j组数据构建的对陀螺仪和加速度计的非线性函数,i=1,2,...,6。
(3)非线性方程组的二范数表示如下:
Figure BDA0002878801480000045
Figure BDA0002878801480000046
其中,|| ||2表示二范数。
(4)将公式(3)和公式(4)中非线性方程组的最优解转换为求其二范数最小值的优化问题,如下:
Figure BDA0002878801480000047
Figure BDA0002878801480000048
其中,min表示取最小值,s.t.表示约束条件,diag表示将向量转换为对角矩阵的构建函数,wgn表示第n个陀螺仪的权重,n=1,2,...,N,N为陀螺仪个数,wam表示第m个加速度计的权重,m=1,2,...,M,M为加速度计个数。
(5)设计约束型果蝇优化算法对最小二范数进行最优估计,最终获得陀螺仪加权最小二乘的最优权重。约束型果蝇优化算法设计如下:
(a)初始化果蝇群体位置:
Figure BDA0002878801480000051
其中,D_axis表示果蝇群体位置K维向量,dk_axis表示果蝇群体位置向量中第k维的值,k=1,2,...,K,初始化时dk_axis随机给定。
(b)以群体位置为中心,果蝇个体随机向四周飞出觅食,果蝇个体位置具体表示如下:
Figure BDA0002878801480000052
其中,Dl表示第l个果蝇个体位置,l=1,2,...,L,L为群体中的果蝇总数,Rk表示果蝇个体位置向量中第k维的随机数。
(c)计算果蝇个体味道浓度和味道污染度:
Figure BDA0002878801480000053
其中,Sl为第l个果蝇个体的味道浓度,Pl为第l个果蝇个体的味道污染度,sFunction为味道浓度判定函数,pFunction为味道污染度判定函数。
对于陀螺仪,味道浓度判定函数可表示如下:
sFunction(Dgl)=1/||Fg(diag(Dgl))||2 (12)
其中,Dgl为应用于陀螺仪时的果蝇个体位置。
对于加速度计,味道浓度判定函数可表示如下:
sFunction(Dal)=1/||Fa(diag(Dal))||2 (13)
其中,Dal为应用于加速度计时的果蝇个体位置。
对于陀螺仪,味道污染度判定函数可表示如下:
Figure BDA0002878801480000061
其中,εg为一个较小的正数,根据实际情况确定,dgln为应用于陀螺仪时的果蝇个体位置向量第n维的值。
对于加速度计,味道污染度判定函数可表示如下:
Figure BDA0002878801480000062
其中,εa为一个较小的正数,根据实际情况确定,dalm为应用于加速度计时的果蝇个体位置向量第m维的值。
(d)计算果蝇群体位置处的味道浓度和味道污染度,将所有果蝇个体位置和群体位置一起考虑,先按味道污染度升序排序,味道污染度相同的按味道浓度降序排序,取排序第一为最佳果蝇个体,该个体的味道污染度、味道浓度及位置保留为最优味道污染度、最优味道浓度及最优位置,所有果蝇个体向该位置聚集,该位置即更新为新的群体位置,具体表示如下:
Figure BDA0002878801480000071
其中,S_axis为群体位置处的味道浓度,P_axis为群体位置处的味道污染度,S_best为最优味道浓度,P_best为最优味道污染度,D_best为最优位置。
(e)设置合理的果蝇总数和迭代次数,重复步骤(b)~(d)迭代计算,最后更新的群体位置即为最终的最优位置。
(6)将约束型果蝇优化算法估计出的最优位置转换为陀螺仪和加速度计加权最小二乘的最优权重矩阵:
Wg_best=diag(Dg_axis) (17)
Wa_best=diag(Da_axis) (18)
其中,Wg_best和Wa_best分别为陀螺仪和加速度计加权最小二乘最优权重,Dg_axis和Da_axis分别为应用于陀螺仪和加速度计时获得的最优位置。
本发明所述的RIMU的配置结构包含三轴正交多表结构、斜置冗余结构、正棱锥结构、正四面体结构、正十二面体结构和十八面体结构。
本发明的发明原理是:通过在大理石平台上变换不同的RIMU摆放位置充分激活各项影响测量精度的因素,并根据静止位置天向角速率和加速度恒定的特点,构建关于加权最小二乘权重的非线性方程组;设计约束型果蝇优化算法估计该非线性方程组的最小二范数,以此获得RIMU数据融合的最优权重。
本发明的方案与现有方案比,主要优点在于:估计的加权最小二乘权重充分考虑了各种影响RIMU测量精度的因素,而不是仅采用其中一种影响因素来配置权重,可进一步有效提高RIMU数据融合测量精度。
附图说明
图1具体实施方案图;
图2 RIMU在大理石平台上摆放位置1图;
图3 RIMU在大理石平台上摆放位置2图;
图4 RIMU在大理石平台上摆放位置3图;
图5 RIMU在大理石平台上摆放位置4图;
图6 RIMU在大理石平台上摆放位置5图;
图7 RIMU在大理石平台上摆放位置6图。
具体实施方案
本发明的具体实施方案如图1所示,将RIMU先后六个面朝上放置于大理石平台上,采集各个位置陀螺仪和加速度计数据,利用加权最小二乘法对陀螺仪和加速度计数据进行数据融合将其转换为RIMU坐标系下等效三轴的测量信息,并根据大理石平台天向角速率和加速度恒定的特点,构建关于加权最小二乘权重的非线性方程组。之后将构建的非线性方程组的最优解求解问题转换为求其二范数最小值的优化问题,并设计约束型果蝇优化算法进行最优估计,最终获得RIMU中陀螺仪和加速度计加权最小二乘的最优权重。具体实施步骤如下:
(1)分别将RIMUx轴朝上、x轴朝下、y轴朝上、y轴朝下、z轴朝上和z轴朝下依次放置于大理石平台上,如图2~图7所示,定义为位置1~6,在每个位置每1秒采集1组陀螺仪和加速度计数据,持续采集1分钟,分别对陀螺仪和加速度计构建各位置单组数据的非线性方程如下:
Figure BDA0002878801480000091
Figure BDA0002878801480000092
其中,
Figure BDA0002878801480000093
Figure BDA0002878801480000094
分别表示第1~6个位置第j组数据关于陀螺仪和加速度计加权最小二乘权重的非线性函数,j=1,2,...,60,Wg和Wa分别表示陀螺仪和加速度计加权最小二乘权重矩阵,Hg和Ha分别表示陀螺仪和加速度计的配置结构矩阵,ωr1j、ωr2j、ωr3j、ωr4j、ωr5j和ωr6j分别表示所有陀螺仪在第1~6个位置采集的第j组数据,ar1j、ar2j、ar3j、ar4j、ar5j和ar6j分别表示所有加速度计在第1~6个位置采集的第j组数据,|x、|y和|z分别表示取RIMU坐标系x、y和z轴数据,Ω表示地球自转角速率的大小,sin表示正弦函数,L表示当地纬度,G表示当地重力加速度大小。
(2)以陀螺仪为例,利用RIMU各个位置采集的所有数据构建关于加权最小二乘权重的非线性方程组如下:
Figure BDA0002878801480000101
其中,Fg表示关于加权最小二乘权重的非线性函数组,
Figure BDA0002878801480000102
表示第i个位置第j组数据构建的非线性函数,i=1,2,...,6。
(3)非线性方程组的二范数表示如下:
Figure BDA0002878801480000103
其中,|| ||2表示二范数。
(4)将公式(21)中非线性方程组的最优解转换为求其二范数最小值的优化问题,如下:
Figure BDA0002878801480000104
其中,min表示取最小值,s.t.表示约束条件,diag表示对角矩阵,wgn表示第n个陀螺仪的权重,n=1,2,...,N,N为陀螺仪个数。
(5)设计约束型果蝇优化算法,首先初始化果蝇群体位置:
Figure BDA0002878801480000105
其中,D_axis表示果蝇群体位置K维向量,dk_axis表示果蝇群体位置向量中第k维的值,k=1,2,...,K,初始化时dk_axis随机取值;应用于陀螺仪时,取K=N。
(6)以群体位置为中心,果蝇个体随机向四周飞出觅食,果蝇个体位置具体表示如下:
Figure BDA0002878801480000111
其中,Dl表示第l个果蝇个体位置,l=1,2,...,L,L为群体中的果蝇总数,Rk表示果蝇个体位置向量中第k维的随机数。
(7)计算果蝇个体味道浓度和味道污染度:
Figure BDA0002878801480000112
其中,Sl为第l个果蝇个体的味道浓度,Pl为第l个果蝇个体的味道污染度,sFunction为味道浓度判定函数,pFunction为味道污染度判定函数。
对于陀螺仪,味道浓度判定函数可表示如下:
sFunction(Dgl)=1/||Fg(diag(Dgl))||2 (27)
其中,Dgl为应用于陀螺仪时的果蝇个体位置。
味道污染度判定函数可表示如下:
Figure BDA0002878801480000113
其中,在本案例中εg取0.01,其他案例可视具体情况确定,dgln为应用于陀螺仪时的果蝇个体位置向量第n维的值。
(8)计算果蝇群体位置处的味道浓度和味道污染度,将所有果蝇个体位置和群体位置一起考虑,先按味道污染度升序排序,味道污染度相同的按味道浓度降序排序,取排序第一为最佳果蝇个体,该个体的味道污染度、味道浓度及位置保留为最优味道污染度、最优味道浓度及最优位置,所有果蝇个体向该位置聚集,该位置即更新为新的群体位置,具体表示如下:
Figure BDA0002878801480000121
其中,S_axis为群体位置处的味道浓度,P_axis为群体位置处的味道污染度,S_best为最优味道浓度,P_best为最优味道污染度,D_best为最优位置。
(9)本案例中,设置果蝇总数为100和迭代次数为100,其他案例可视情况设置果蝇总数和迭代次数。对优化算法迭代计算,最后更新的群体位置即为最终的最优位置,将最优位置转换为陀螺仪加权最小二乘的最优权重矩阵:
Wg_best=diag(Dg_axis) (30)
其中,Wg_best为陀螺仪加权最小二乘最优权重,Dg_axis为应用于陀螺仪时获得的最优位置;
同理,按陀螺仪加权最小二乘最优权重估计的步骤,可估计出加速度计加权最小二乘的最优权重矩阵。
为了验证本发明方法的有效性和优越性,以正四面体冗余配置RIMU陀螺仪为例,分别采用本发明方法、最小二乘法和马尔可夫估计法对RIMU进行数据融合仿真,比较这三种方法的数据融合测量精度。由于仿真的局限性,无法对所有影响测量精度的因素进行模拟,在此仅对零偏重复性和零偏稳定性进行仿真。仿真条件按三种情况进行设置,分别如下:
(1)零偏重复性一致,零偏稳定性升序变化;
(2)零偏重复性升序变化,零偏稳定性一致;
(3)零偏重复性降序变化,零偏稳定性升序变化。
具体仿真参数如表1所示。
表1仿真用RIMU陀螺仪参数
Figure BDA0002878801480000131
每种仿真中,先按本发明方法估计RIMU数据融合最优权重,然后将RIMU静止放置,采用1000次蒙特卡洛仿真法分别使用本发明方法、最小二乘法和马尔可夫估计法的权重对RIMU数据进行加权最小二乘数据融合。其中,最小二乘法的权重矩阵为单位阵,马尔可夫估计法的权重矩阵为噪声方差阵的逆矩阵。蒙特卡洛仿真结果如表2所示。
表2 1000次蒙特卡洛仿真结果
Figure BDA0002878801480000132
从蒙特卡洛仿真结果可以看出,仿真(1)中零偏重复性一致,因此影响权重取值的只有零偏稳定性,而零偏稳定性的仿真采用理想高斯白噪声,理论上马尔可夫估计法的权重为最优权重,从结果看本发明方法所获得的测量精度与马尔可夫估计法相当,因此可验证本发明方法的有效性。在仿真(2)中零偏稳定性一致,因此马尔可夫估计法的权重为单位矩阵,与最小二乘法一致,其测量精度也一致,两者均没有考虑零偏重复性对权重的影响,而本发明方法充分考虑各种影响因素,包含零偏重复性,因此其测量精度均明显由于前两者。在仿真(3)中零偏稳定性升序变化,而零偏重复性降序变化,两者正好抵消,因此最小二乘法表现出最好的测量精度,而马尔可夫估计由于仅考虑零偏稳定性,其测量精度较差,本发明方法获得了与最小二乘法相当的效果。
整体来说,最小二乘法适合所有传感器测量精度一致的情况,而马尔可夫估计适合RIMU测量精度仅受零偏稳定性影响的情况,这两种情况在实际使用中均较难实现。而本发明方法综合考虑了各种影响RIMU测量精度的因素,仅需要对具体的RIMU进行标定即可获得其最优权重,更适合RIMU数据融合的实际应用。
因此,本发明方法可对RIMU数据融合中加权最小二乘的权重进行最优估计,很好地解决了实际应用中加权最小二乘法权重配置不佳的问题,明显改善了RIMU测量精度,为RIMU高精度长航时导航提供了技术基础。
本发明书中未作详细描述的内容属于本领域专业技术人员公知的现有技术。

Claims (8)

1.一种冗余惯性测量单元数据融合最优权重估计方法,其特征在于将惯性测量单元先后六个面朝上放置于大理石平台上,采集各个位置陀螺仪和加速度计数据,利用加权最小二乘法对陀螺仪和加速度计数据进行数据融合将其转换为惯性测量单元坐标系下等效三轴的测量信息,并根据大理石平台天向角速率和加速度恒定的特点,构建关于加权最小二乘权重的非线性方程组,具体包括以下步骤:
(1)分别将惯性测量单元x轴朝上、x轴朝下、y轴朝上、y轴朝下、z轴朝上和z轴朝下依次放置于大理石平台上,定义为位置1~6,在每个位置每1秒采集1组陀螺仪和加速度计数据,持续采集1分钟,分别对陀螺仪和加速度计构建各位置单组数据的非线性方程如下:
Figure FDA0002878801470000011
Figure FDA0002878801470000012
其中,
Figure FDA0002878801470000021
Figure FDA0002878801470000022
分别表示第1~6个位置第j组数据关于陀螺仪和加速度计加权最小二乘权重的非线性函数,j=1,2,...,60,Wg和Wa分别表示陀螺仪和加速度计加权最小二乘权重矩阵,Hg和Ha分别表示陀螺仪和加速度计的配置结构矩阵,ωr1j、ωr2j、ωr3j、ωr4j、ωr5j和ωr6j分别表示所有陀螺仪在第1~6个位置采集的第j组数据,ar1j、ar2j、ar3j、ar4j、ar5j和ar6j分别表示所有加速度计在第1~6个位置采集的第j组数据,|x、|y和|z分别表示取惯性测量单元坐标系x、y和z轴数据,Ω表示地球自转角速率的大小,sin表示正弦函数,L表示当地纬度,G表示当地重力加速度大小;
(2)利用惯性测量单元各个位置采集的所有数据分别对陀螺仪和加速度计构建关于加权最小二乘权重的非线性方程组如下:
Figure FDA0002878801470000023
Figure FDA0002878801470000024
其中,Fg和Fa分别表示对陀螺仪和加速度计的关于加权最小二乘权重的非线性函数组,
Figure FDA0002878801470000025
Figure FDA0002878801470000026
分别表示第i个位置第j组数据构建的对陀螺仪和加速度计的非线性函数,i=1,2,...,6;
(3)对公式(3)和公式(4)求最优解,其值即为陀螺仪和加速度计加权最小二乘的最优权重。
2.根据权利要求1所述的一种冗余惯性测量单元数据融合最优权重估计方法,其特征还在于将公式(3)和公式(4)的最优解求解问题转换为求其二范数最小值的优化问题,并设计约束型果蝇优化算法进行最优估计,最终获得陀螺仪和加速度计加权最小二乘的最优权重,具体包括以下步骤:
(1)公式(3)和公式(4)的二范数表示如下:
Figure FDA0002878801470000031
Figure FDA0002878801470000032
其中,|| ||2表示二范数;
(2)将公式(3)和公式(4)中非线性方程组的最优解转换为求其二范数最小值的优化问题,如下:
Figure FDA0002878801470000033
Figure FDA0002878801470000034
其中,min表示取最小值,s.t.表示约束条件,diag表示将向量转换为对角矩阵的构建函数,wgn表示第n个陀螺仪的权重,n=1,2,...,N,N为陀螺仪个数,wam表示第m个加速度计的权重,m=1,2,...,M,M为加速度计个数;
(3)设计约束型果蝇优化算法分别对公式(7)和公式(8)进行最优估计,获得陀螺仪和加速度计加权最小二乘的最优权重。
3.根据权利要求1所述的一种冗余惯性测量单元数据融合最优权重估计方法,其特征还在于权利要求2所述的约束型果蝇优化算法具体包括以下步骤:
(1)初始化果蝇群体位置:
Figure FDA0002878801470000041
其中,D_axis表示果蝇群体位置K维向量,dk_axis表示果蝇群体位置向量中第k维的值,k=1,2,...,K,初始化时dk_axis随机给定;
(2)以群体位置为中心,果蝇个体随机向四周飞出觅食,果蝇个体位置具体表示如下:
Figure FDA0002878801470000042
其中,Dl表示第l个果蝇个体位置,l=1,2,...,L,L为群体中的果蝇总数,Rk表示果蝇个体位置向量中第k维的随机数;
(3)计算果蝇个体味道浓度和味道污染度:
Figure FDA0002878801470000043
其中,Sl为第l个果蝇个体的味道浓度,Pl为第l个果蝇个体的味道污染度,sFunction为味道浓度判定函数,pFunction为味道污染度判定函数;
(4)计算果蝇群体位置处的味道浓度和味道污染度,将所有果蝇个体位置和群体位置一起考虑,先按味道污染度升序排序,味道污染度相同的按味道浓度降序排序,取排序第一为最佳果蝇个体,该个体的味道污染度、味道浓度及位置保留为最优味道污染度、最优味道浓度及最优位置,所有果蝇个体向该位置聚集,该位置即更新为新的群体位置,具体表示如下:
Figure FDA0002878801470000044
其中,S_axis为群体位置处的味道浓度,P_axis为群体位置处的味道污染度,S_best为最优味道浓度,P_best为最优味道污染度,D_best为最优位置;
(5)设置果蝇总数L和迭代次数,具体果蝇总数和迭代次数根据实际情况确定,重复权利要求3中的步骤(1)~(4),迭代计算,最后更新的群体位置即为最终的最优位置。
4.根据权利要求1所述的一种冗余惯性测量单元数据融合最优权重估计方法,其特征还在于权利要求3所述的果蝇群体或个体的位置,在应用于陀螺仪时位置的维度为陀螺仪的个数,即K=N;在应用于加速度计时位置的维度为加速度计的个数,即K=M。
5.根据权利要求1所述的一种冗余惯性测量单元数据融合最优权重估计方法,其特征还在于权利要求3所述的味道浓度判定函数,根据公式(7),在应用于陀螺仪时表示如下:
sFunction(Dgl)=1/||Fg(diag(Dgl))||2 (13)
其中,Dgl为应用于陀螺仪时的果蝇个体位置;
根据公式(8),在应用于加速度计时表示如下:
sFunction(Dal)=1/||Fa(diag(Dal))||2 (14)
其中,Dal为应用于加速度计时的果蝇个体位置。
6.根据权利要求1所述的一种冗余惯性测量单元数据融合最优权重估计方法,其特征还在于权利要求3所述的味道污染度判定函数,根据公式(7),在应用于陀螺仪时表示如下:
Figure FDA0002878801470000061
其中,εg取一个较小的正数,根据实际情况确定,dgln为应用于陀螺仪时的果蝇个体位置向量第n维的值;
根据公式(8),在应用于加速度计时表示如下:
Figure FDA0002878801470000062
其中,εa取一个较小的正数,根据实际情况确定,dalm为应用于加速度计时的果蝇个体位置向量第m维的值。
7.根据权利要求1所述的一种冗余惯性测量单元数据融合最优权重估计方法,其特征还在于权利要求3的步骤(5)得到最优位置后,在应用于陀螺仪时将最优位置转换为陀螺仪加权最小二乘的最优权重矩阵:
Wg_best=diag(Dg_axis) (17)
其中,Wg_best为陀螺仪加权最小二乘最优权重,Dg_axis为应用于陀螺仪时获得的最优位置;
在应用于加速度计时将最优位置转换为加速度计加权最小二乘的最优权重矩阵:
Wa_best=diag(Da_axis) (18)
其中,Wa_best为加速度计加权最小二乘最优权重,Da_axis为应用于加速度计时获得的最优位置。
8.根据权利要求1所述的一种冗余惯性测量单元数据融合最优权重估计方法,其特征还在于所述的冗余惯性测量单元的配置结构包含三轴正交多表结构、斜置冗余结构、正棱锥结构、正四面体结构、正十二面体结构和十八面体结构。
CN202011623560.4A 2020-12-31 2020-12-31 一种冗余惯性测量单元数据融合最优权重估计方法 Active CN112815937B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202011623560.4A CN112815937B (zh) 2020-12-31 2020-12-31 一种冗余惯性测量单元数据融合最优权重估计方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202011623560.4A CN112815937B (zh) 2020-12-31 2020-12-31 一种冗余惯性测量单元数据融合最优权重估计方法

Publications (2)

Publication Number Publication Date
CN112815937A true CN112815937A (zh) 2021-05-18
CN112815937B CN112815937B (zh) 2023-08-01

Family

ID=75854687

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202011623560.4A Active CN112815937B (zh) 2020-12-31 2020-12-31 一种冗余惯性测量单元数据融合最优权重估计方法

Country Status (1)

Country Link
CN (1) CN112815937B (zh)

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113566850A (zh) * 2021-07-29 2021-10-29 深圳元戎启行科技有限公司 惯性测量单元的安装角度标定方法、装置和计算机设备
CN114526729A (zh) * 2022-01-14 2022-05-24 重庆邮电大学 一种基于冗余技术的mems惯性定位系统航向优化方法
CN115060259A (zh) * 2022-08-19 2022-09-16 江苏德一佳安防科技有限公司 多imu融合的定位系统及方法

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102679983A (zh) * 2012-04-26 2012-09-19 北京航空航天大学 一种余度惯性测量单元测量噪声估计和数据融合方法
CN102706347A (zh) * 2012-05-17 2012-10-03 南京航空航天大学 一种惯性传感器网络节点装置及其信息融合方法
US20160047675A1 (en) * 2005-04-19 2016-02-18 Tanenhaus & Associates, Inc. Inertial Measurement and Navigation System And Method Having Low Drift MEMS Gyroscopes And Accelerometers Operable In GPS Denied Environments
CN107202576A (zh) * 2017-05-19 2017-09-26 哈尔滨工程大学 一种四冗余双轴旋转调制捷联惯性导航系统及导航方法
CN110006455A (zh) * 2019-04-24 2019-07-12 保定开拓精密仪器制造有限责任公司 用于冗余惯导系统中加速度计误差参数的快速标定方法

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20160047675A1 (en) * 2005-04-19 2016-02-18 Tanenhaus & Associates, Inc. Inertial Measurement and Navigation System And Method Having Low Drift MEMS Gyroscopes And Accelerometers Operable In GPS Denied Environments
CN102679983A (zh) * 2012-04-26 2012-09-19 北京航空航天大学 一种余度惯性测量单元测量噪声估计和数据融合方法
CN102706347A (zh) * 2012-05-17 2012-10-03 南京航空航天大学 一种惯性传感器网络节点装置及其信息融合方法
CN107202576A (zh) * 2017-05-19 2017-09-26 哈尔滨工程大学 一种四冗余双轴旋转调制捷联惯性导航系统及导航方法
CN110006455A (zh) * 2019-04-24 2019-07-12 保定开拓精密仪器制造有限责任公司 用于冗余惯导系统中加速度计误差参数的快速标定方法

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
李雪莲等: "基于最小二乘法的冗余信息数据融合算法实现", 《计算机工程与应用》 *

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113566850A (zh) * 2021-07-29 2021-10-29 深圳元戎启行科技有限公司 惯性测量单元的安装角度标定方法、装置和计算机设备
CN113566850B (zh) * 2021-07-29 2024-03-08 深圳元戎启行科技有限公司 惯性测量单元的安装角度标定方法、装置和计算机设备
CN114526729A (zh) * 2022-01-14 2022-05-24 重庆邮电大学 一种基于冗余技术的mems惯性定位系统航向优化方法
CN114526729B (zh) * 2022-01-14 2023-11-17 重庆邮电大学 一种基于冗余技术的mems惯性定位系统航向优化方法
CN115060259A (zh) * 2022-08-19 2022-09-16 江苏德一佳安防科技有限公司 多imu融合的定位系统及方法

Also Published As

Publication number Publication date
CN112815937B (zh) 2023-08-01

Similar Documents

Publication Publication Date Title
CN112815937B (zh) 一种冗余惯性测量单元数据融合最优权重估计方法
CN108592952B (zh) 基于杆臂补偿与正反倍速率同时标定多mimu误差的方法
CN109974714A (zh) 一种Sage-Husa自适应无迹卡尔曼滤波姿态数据融合方法
Cai et al. Accelerometer calibration with nonlinear scale factor based on multi-position observation
CN106017452B (zh) 双陀螺抗扰动寻北方法
CN110174123B (zh) 一种磁传感器实时标定方法
Cao et al. A new continuous self-calibration scheme for a gimbaled inertial measurement unit
CN109682377A (zh) 一种基于动态步长梯度下降的姿态估计方法
CN110361683A (zh) 基于双目标函数粒子群优化的磁力计校正方法
CN108021138B (zh) 一种地磁场模型简化设计方法
CN107101649B (zh) 一种空间飞行器制导工具在轨误差分离方法
CN112683274A (zh) 一种基于无迹卡尔曼滤波的无人机组合导航方法和系统
CN111121820B (zh) 基于卡尔曼滤波的mems惯性传感器阵列融合方法
CN107764261A (zh) 一种分布式pos传递对准用模拟数据生成方法和系统
CN113916222A (zh) 基于卡尔曼滤波估计方差约束的组合导航方法
CN111649747A (zh) 一种基于imu的自适应ekf姿态测量改进方法
Dhalwar et al. Adaptive parameter based particle swarm optimisation for accelerometer calibration
CN113137977B (zh) 一种sins/偏振光组合导航初始对准滤波方法
CN108871319B (zh) 一种基于地球重力场与地磁场序贯修正的姿态解算方法
CN110375773B (zh) Mems惯导系统姿态初始化方法
Brunner et al. Evaluation of attitude estimation algorithms using absolute magnetic reference data: Methodology and results
Xing et al. Offline calibration for MEMS gyroscope g-sensitivity error coefficients based on the Newton iteration and least square methods
CN108871312A (zh) 一种重力梯度仪及星敏感器的联合定姿方法
Xu et al. Three-position characterization for the adjustment of MEMS accelerometer scale factor
CN113188540A (zh) 基于恒星数目和构型的惯性/天文自适应滤波方法

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