CN106482746A - 一种用于混合式惯导系统的加速度计内杆臂标定与补偿方法 - Google Patents

一种用于混合式惯导系统的加速度计内杆臂标定与补偿方法 Download PDF

Info

Publication number
CN106482746A
CN106482746A CN201611063512.8A CN201611063512A CN106482746A CN 106482746 A CN106482746 A CN 106482746A CN 201611063512 A CN201611063512 A CN 201611063512A CN 106482746 A CN106482746 A CN 106482746A
Authority
CN
China
Prior art keywords
omega
accelerometer
lever arm
inertial navigation
navigation system
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
CN201611063512.8A
Other languages
English (en)
Other versions
CN106482746B (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.)
Beihang University
Original Assignee
Beihang 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 Beihang University filed Critical Beihang University
Priority to CN201611063512.8A priority Critical patent/CN106482746B/zh
Publication of CN106482746A publication Critical patent/CN106482746A/zh
Application granted granted Critical
Publication of CN106482746B publication Critical patent/CN106482746B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C25/00Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
    • G01C25/005Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass initial alignment, calibration or starting-up of inertial devices

Landscapes

  • Engineering & Computer Science (AREA)
  • Manufacturing & Machinery (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Navigation (AREA)

Abstract

本发明公开了一种用于混合式惯导系统的加速度计内杆臂的标定与补偿方法。本发明分析了加速度计内杆臂效应的产生机理,并基于此设计了一种变角速度的旋转方案,可实现对全部9个内杆臂参数的激励;同时,建立了以速度误差为观测量的卡尔曼滤波模型,可对内杆臂参数进行估计;此外,还给出了加速度计内杆臂参数的补偿模型。利用混合式惯导系统的三环框架结构,系统无须借助三轴转台等外界设备,即可实现加速度计内杆臂参数的自标定。本发明为混合式惯导系统的加速度计内杆臂的标定与补偿问题提供了解决方案,具有很强的实用价值。

Description

一种用于混合式惯导系统的加速度计内杆臂标定与补偿方法
技术领域
本发明涉及一种用于混合式惯导系统的加速度计内杆臂标定与补偿方法,主要适用于混合式惯导系统的内杆臂参数标定,属于惯性导航技术领域。
背景技术
在惯导系统进行导航解算的过程中,通常都将惯性测量单元(IMU)看作点测量元件,但由于加速度计本身尺寸和安装条件的限制,加速度计的测量点不可能与IMU中心重合。根据刚体转动定理可知,当IMU存在角运动时,会使加速度计输出中产生沿切向和法向的加速度误差,从而影响导航精度,这种现象称为“内杆臂效应”。
在混合式惯导系统中,为更好的调制惯性器件误差,通常根据应用场合设计不同的IMU旋转方案,这会激励出内杆臂效应误差,从而对内杆臂参数的精确标定提出了更高要求。
发明内容
本发明解决的技术问题是:克服现有技术的不足,提供一种用于混合式惯导系统的加速度计内杆臂标定与补偿方法,利用混合式惯导系统的三环框架结构,通过使IMU按一定次序进行变角速度旋转,可激励出全部内杆臂参数,同时通过卡尔曼滤波模型进行估计,大大提升了标定效率;本发明的内杆臂参数标定过程无须依赖外部设备,这也是混合式惯导系统具备装机自标定能力的重要体现。实验证明,经本发明对加速度计内杆臂参数进行标定和补偿后,混合式惯导系统的导航精度显著提高。
本发明的技术解决方案:一种用于混合式惯导系统的加速度计内杆臂标定与补偿方法,其特点在于:利用混合式惯导系统的三环框架结构,设计了变角速度旋转方案激励全部内杆臂参数;所述的标定模型是以速度误差为观测量的卡尔曼滤波模型,通过该方法,可实现对全部9个内杆臂参数的标定。
本发明的原理是:由于加速度计内杆臂参数在受到变角速度运动影响时,在速度误差中会呈现出不同形式的变化规律,所以通过使IMU按一定次序进行变角速度旋转,可有效地激励内杆臂参数。此外,通过采用以速度误差为观测的卡尔曼滤波模型,可以实现全部内杆臂参数的估计。本发明分析了加速度计内杆臂效应的产生机理,并基于此设计了一种变角速度的旋转方案,可实现对全部9个内杆臂参数的激励;同时,建立了以速度误差为观测量的卡尔曼滤波模型,可对内杆臂参数进行估计;此外,还给出了加速度计内杆臂参数的补偿模型。
本发明技术解决方案:一种用于混合式惯导系统的加速度计内杆臂标定与补偿方法,包括如下步骤:
步骤一:对混合式惯导系统进行初始对准;
步骤二:初始对准完成后,混合式惯导系统的三环框架按照变角速度的旋转方案,同时进行导航解算,实现对加速度计的全部9个内杆臂参数的激励;
步骤三:在执行步骤二的过程中,利用以速度误差为观测的卡尔曼滤波模型对加速度计内杆臂参数进行估计,得到加速度计内杆臂参数的估计结果;
步骤四:对步骤三得到的加速度计内杆臂参数的估计结果进行补偿,得到补偿后的加速度计输出。
所述步骤二中,加速度计的全部9个杆臂参数,x、y和z轴加速度计的杆臂参数的测量敏感点相对于惯性测量单元IMU中心的位置关系分别用三维坐标表示为:
对于任意加速度计而言,当惯性测量单元IMU旋转时,由内杆臂引起的加速度计测量误差包括切向加速度和法向加速度,表示为:
其中,p系为IMU台体坐标系,表示由内杆臂引起的加速度计测量误差矢量,表示p系的旋转角速度矢量,表示p系的旋转角加速度矢量,rp表示内杆臂矢量,表示切向加速度误差,表示法向加速度误差。
写成分量形式如下:
其中,M={mij},i,j=1,2,3,的三个分量, 的三个分量,是rp的三个分量,在IMU存在旋转运动时,由内杆臂引起的加速度计测量误差表示为:
其中,分别表示x,y,z加速度计的测量误差矢量, 分别表示沿对应的加速度计敏感轴方向的测量误差;由此可以看出,在受到变角速度旋转的激励时,不同杆臂参数在加速度误差中的变化规律都各不相同,因此通过设置旋转方案实现对全部9个杆臂参数的激励;
所述变角速度旋转方案,方案如下:
(1)先将混合式惯导系统的三轴框架回零,此时z轴陀螺指天,绕内框电机轴进行变角速度正反转,重复次数控制在2-5次,持续时间控制在120-300秒;
(2)绕外框电机轴,以3-10°/s的角速度逆时针转到-90°,此时x陀螺指天;
(3)绕中框电机轴进行变角速度正反转,重复次数控制在2-5次,持续时间控制在120-300秒;
(4)绕内框电机轴,以3-10°/s的角速度逆时针转到-90°,此时y陀螺指天;
(5)绕中框电机轴进行变角速度正反转,重复次数控制在2-5次,持续时间控制在120-300秒;
通过按此次序控制电机轴的旋转,实现对全部杆臂参数的激励,绕每个轴旋转的指令角速度都按正弦规律变化。
所述步骤三中,利用以速度误差为观测的卡尔曼滤波模型对加速度计内杆臂参数进行估计,得到估计后的加速度计内杆臂参数过程如下:
卡尔曼滤波模型以惯导东向和北向的速度误差为观测信息,以静基座误差模型为基础建立包含内杆臂参数的状态方程,状态量包括速度、位置误差,IMU台体失准角,陀螺敏感轴漂移,加速度计敏感轴零偏,内杆臂参数,共22维;
卡尔曼滤波模型为:
Z(t)=H(t)X(t)+V(t)
其中,F(t)为状态转移矩阵,X(t)为状态向量,Z(t)为观测量,H(t)为观测矩阵,W(t)、V(t)分别为系统噪声和观测噪声,均为白噪声;
其中,δVE,δVN表示东向和北向速度误差,δL,δλ表示纬度和经度位置误差,δφE,δφN,δφU表示台体失准角,εxyz表示敏感轴陀螺漂移,▽x,▽y,▽z表示敏感轴加计零偏,表示9个内杆臂参数。
状态转移矩阵写成分块矩阵的形式,
其中:FM(t)7×7建立了导航误差之间的关系,FN(t)7×15建立了导航误差与传感器误差之间的关系。
其中,ΩN,ΩU表示地球自转沿北向和天向的分量,RM,RN都表示地球半径,L表示当地纬度,g表示重力加速度。表示m行n列的分块矩阵,q表示非零分块矩阵的序号,0m×n表示m行n列的零矩阵。p代表惯性平台坐标系,n代表东-北-天地理系,是p系到n系的坐标变换阵,M矩阵建立了内杆臂参数与加速度误差之间的关系,M={mij},i,j=1,2,3。 代表陀螺敏感到的角速度信息,代表差分得到的角加速度信息。卡尔曼滤波模型以东向和北向的速度误差作为观测量,观测方程可写为:
H=[I2×2 02×20]
其中,可观测矩阵H为常值矩阵,I2×2表示2阶单位矩阵。
所述步骤四中:补偿方案如下:
其中,分别为补偿前的x,y,z加速度计输出,分别为补偿后的x,y,z加速度计输出。
所述方法也可以捷联惯导系统中使用,在捷联式惯导系统的加计内杆臂参数标定中,可以借助三轴转台实现相同的旋转过程。
本发明与现有技术相比优点在于:
(1)本发明利用混合式惯导系统的三轴框架结构,无须借助外界设备即可实现加速度计内杆臂的标定与补偿,因此具有很强的实用性。
(2)本发明针对IMU的加速度计内杆臂效应问题,提出了一种变角速度的旋转方案,可以快速准确的估计出全部内杆臂参数,较现有技术而言,大大提高了标定精度和效率。
附图说明
图1为加速度计内杆臂参数模型示意图;
图2为本发明方法的实现流程图;
图3为一种变角速度旋转方案;
图4为一组加速度计内杆臂标定实验的收敛曲线;
图5为加计内杆臂参数补偿前后的导航结果对比图。
具体实施方式
对于加速度计内杆臂效应的误差机理说明如下:
对于任意加速度计而言,当惯性测量单元(IMU)旋转时,由内杆臂引起的加速度计测量误差包括切向加速度和法向加速度,可以表示为:
其中,p系为IMU台体坐标系,表示由内杆臂引起的加速度计测量误差矢量,表示p系的旋转角速度矢量,表示p系的旋转角加速度矢量,rp表示内杆臂矢量,表示切向加速度误差,表示法向加速度误差。
写成分量形式如下:
其中,M={mij},i,j=1,2,3,的三个分量, 的三个分量,是rp的三个分量。
如图1所示为加速度计内杆臂参数模型示意图,每个加速度计相对于IMU中心的位置关系都可以用三维坐标表示,x,y,z加速度计的杆臂参数可分别表示为在IMU存在旋转运动时,由内杆臂引起的加速度计测量误差可表示为:
其中,分别表示x,y,z加速度计的测量误差矢量, 分别表示沿对应的加速度计敏感轴方向的测量误差。
如图2所示,本发明所述的标定方法包括如下步骤:
步骤一:将混合式惯导系统固定在平稳台面上,检查电缆和数据传输线的连通状态,然后完成初始对准过程。所述的初始对准技术为本领域技术人员公知的常识。
步骤二:初始对准完成后,混合式惯导系统的三环框架按方案进行变角速度旋转,同时进行导航解算。每个框架的正反转角速度都按正弦规律变化,旋转周期为60秒,则全部方案执行完毕共耗时750s。如图3所示,旋转方案流程如下:
(1)先将三轴框架回零,此时z陀螺指天,绕内框电机轴进行变角速度正反转,重复2次,持续时间240秒;
(2)绕外框电机轴,以6°/s的角速度逆时针转到-90°,此时x陀螺指天,持续时间15秒;
(3)绕中框电机轴进行变角速度正反转,重复2次,持续时间240秒;
(4)绕内框电机轴,以6°/s的角速度逆时针转到-90°,此时y陀螺指天,持续时间15秒;
(5)绕中框电机轴进行变角速度正反转,重复2次,持续时间240秒;步骤三:在执行步骤二的过程中,导航计算机利用以速度误差为观测的卡尔曼滤波模型对内杆臂参数进行估计,相关公式如下:
卡尔曼滤波模型为:
Z(t)=H(t)X(t)+V(t)
其中,F(t)为状态转移矩阵,X(t)为状态向量,Z(t)为观测量,H(t)为观测矩阵,W(t)、V(t)分别为系统噪声和观测噪声,均为白噪声。
其中,δVE,δVN表示东向和北向速度误差,δL,δλ表示纬度和经度位置误差,δφE,δφN,δφU表示台体失准角,εxyz表示敏感轴陀螺漂移,▽x,▽y,▽z表示敏感轴加计零偏,表示9个内杆臂参数。
状态转移矩阵写成分块矩阵的形式,
其中:FM(t)7×7建立了导航误差之间的关系,FN(t)7×15建立了导航误差与传感器误差之间的关系。
其中,ΩN,ΩU表示地球自转沿北向和天向的分量,RM,RN都表示地球半径,L表示当地纬度,g表示重力加速度。表示m行n列的分块矩阵,q表示非零分块矩阵的序号,0m×n表示m行n列的零矩阵。p代表惯性平台坐标系,n代表东-北-天地理系,是p系到n系的坐标变换阵,M矩阵建立了内杆臂参数与加速度误差之间的关系,M={mij},i,j=1,2,3。 代表陀螺敏感到的角速度信息,代表差分得到的角加速度信息。卡尔曼滤波模型以东向和北向的速度误差作为观测量,观测方程可写为:
H=[I2×2 02×20]
其中,可观测矩阵H为常值矩阵,I2×2表示2阶单位矩阵。
根据卡尔曼滤波的基本方程,选择合适的滤波初值。P、Q、R阵的初值根据本系统的器件类型和精度选取,若系统器件类型和精度不同,P、Q、R也应作对应改变。所述的P、Q、R参数的取值方法和卡尔曼滤波基本方程为本领域技术人员公知的常识。
P22×22(k)为第k时刻的协方差阵,初值的非零项有:
P1,1(0)=P2,2(0)=(0.1m/s)2,
P3,3(0)=P4,4(0)=(5m/RM)2,
P5,5(0)=P6,6(0)=P7,7(0)=(1°)2,
P8,8(0)=P9,9(0)=P10,10(0)=(0.02°/h)2,
P11,11(0)=P12,12(0)=P13,13(0)=(100μg)2,
P14,14(0)=P15,15(0)=P16,16(0)=(50mm)2,
P17,17(0)=P18,18(0)=P19,19(0)=(50mm)2,
P20,20(0)=P21,21(0)=P22,22(0)=(50mm)2
Q22×22(k)为第k时刻的系统噪声阵,初值的非零项有:
Q1,1(0)=Q2,2(0)=(50μg)2,
Q5,5(0)=Q6,6(0)=Q7,7(0)=(0.01°/h)2
R2×2(k)为第k时刻的量测噪声阵,初值的非零项有:
R1,1(0)=R2,2(0)=(0.001m/s)2,
其中在Pm,n(0),Qm,n(0),Rm,n(0)的分别代表P22×22(0),Q22×22(0),R2×2(0)的第m行第n列元素。初值设置完成后,执行卡尔曼滤波过程,在旋转方案执行完毕后,得到加速度计内杆臂参数的估计结果。
执行卡尔曼滤波过程,在旋转方案执行完毕后,得到加速度计内杆臂参数的估计结果。
步骤四:将步骤三得到的加速度计内杆臂参数进行补偿,补偿过程如下:
其中,分别为补偿前的x,y,z加速度计输出,分别为补偿后的x,y,z加速度计输出。
最后,利用某型三轴混合式惯导系统对本发明所提出的加速度计内杆臂标定方法进行实验验证。为说明本发明估计内杆臂参数的重复性,重复执行上述步骤一~三20次,记录每组实验的估计结果,求取内杆臂参数的平均值和标准差(1σ),如表1所示,其中一组标定实验的估计曲线如图4所示。
表1加速度计内杆臂参数统计结果(单位:毫米)
由表1可以看出,全部内杆臂参数的估计标准差都小于2毫米,重复性较好。最后,按步骤四的模型补偿加速度计内杆臂参数的标定结果,重新进行对准导航实验,对比补偿前后的东、北向速度误差,如图5所示。导航过程中,IMU绕内框电机轴(z陀螺指天)匀速连续正反转,角速度6°/s。可以看出在补偿后,在框架的掉头过程中由杆臂参数引起的速度台阶明显减小,该结果说明了使用本发明的有效性。
总之,本发明利用混合式惯导系统的三环框架结构,系统无须借助三轴转台等外界设备,即可实现加速度计内杆臂参数的自标定。本发明为混合式惯导系统的加速度计内杆臂的标定与补偿问题提供了解决方案,具有很强的实用价值。此外,对于不含三轴框架的惯导系统,可借助高精度的三轴数控转台实现本发明所述的变角速度旋转方案,从而实现该惯导系统的加速度计内杆臂标定与补偿,所以本方法也可推广应用于不含三轴框架的惯导系统中。具体实施步骤包括:
步骤一:将不含三轴框架的惯导系统安装在高精度的三轴数控转台上,检查电缆和数据传输线的连通状态,完成初始对准过程。
步骤二:初始对准完成后,控制三轴转台上的框架按方案进行变角速度旋转,同时进行导航解算。变角速度旋转方案以及步骤二~四的实施与混合式惯导系统所述的方案一致。
本发明未详细公开的部分属于本领域的公知技术。
尽管上面对本发明说明性的具体实施方式进行了描述,以便于本技术领的技术人员理解本发明,但应该清楚,本发明不限于具体实施方式的范围,对本技术领域的普通技术人员来讲,只要各种变化在所附的权利要求限定和确定的本发明的精神和范围内,这些变化是显而易见的,一切利用本发明构思的发明创造均在保护之列。

Claims (5)

1.一种用于混合式惯导系统的加速度计内杆臂标定与补偿方法,其特征在于包括如下步骤:
步骤一:对混合式惯导系统进行初始对准;
步骤二:初始对准完成后进行导航解算,混合式惯导系统的三环框架按照变角速度的旋转方案,实现对加速度计的全部9个内杆臂参数的激励;
步骤三:在执行步骤二的过程中,利用以速度误差为观测的卡尔曼滤波模型对加速度计内杆臂参数进行估计,得到加速度计内杆臂参数的估计结果;
步骤四:对步骤三得到的加速度计内杆臂参数的估计结果进行补偿,得到补偿后的加速度计输出。
2.根据权利要求1所述的用于混合式惯导系统的加速度计内杆臂标定与补偿方法,其特征在于:所述步骤二中,变角速度的旋转方案实现如下:
(1)先将混合式惯导系统的三轴框架回零,此时z轴陀螺指天,绕内框电机轴进行变角速度正反转,重复次数控制在2-5次,持续时间控制在120-300秒;
(2)绕外框电机轴,以3-10°/s的角速度逆时针转到-90°,此时x陀螺指天;
(3)绕中框电机轴进行变角速度正反转,重复次数控制在2-5次,持续时间控制在120-300秒;
(4)绕内框电机轴,以3-10°/s的角速度逆时针转到-90°,此时y陀螺指天;
(5)绕中框电机轴进行变角速度正反转,重复次数控制在2-5次,持续时间控制在120-300秒;
通过按此次序控制电机轴的旋转,实现对全部杆臂参数的激励,绕每个轴旋转的指令角速度都按正弦规律变化。
3.根据权利要求1所述的用于混合式惯导系统的加速度计内杆臂标定与补偿方法,其特征在于:所述步骤三中,利用以速度误差为观测的卡尔曼滤波模型对加速度计内杆臂参数进行估计,得到估计后的加速度计内杆臂参数过程如下:
卡尔曼滤波模型以惯导东向和北向的速度误差为观测信息,以静基座误差模型为基础建立包含内杆臂参数的状态方程,状态量包括速度、位置误差,IMU台体失准角,陀螺敏感轴漂移,加速度计敏感轴零偏,内杆臂参数,共22维;
卡尔曼滤波模型为:
X · ( t ) = F ( t ) X ( t ) + W ( t )
Z(t)=H(t)X(t)+V(t)
其中,F(t)为状态转移矩阵,X(t)为状态向量,Z(t)为观测量,H(t)为观测矩阵,W(t)、V(t)分别为系统噪声和观测噪声,均为白噪声;
X ( t ) = δV E δV N δ L δ λ δφ E δφ N δφ U ϵ x ϵ y ϵ z ▿ x ▿ y ▿ z r x x p r x y p r x z p r y x p r y y p r y z p r z x p r z y p r z z p T
其中,δVE,δVN表示东向和北向速度误差,δL,δλ表示纬度和经度位置误差,δφE,δφN,δφU表示台体失准角,εxyz表示敏感轴陀螺漂移,表示敏感轴加计零偏,表示9个内杆臂参数;
状态转移矩阵写成分块矩阵的形式,
F ( t ) 22 × 22 = F M ( t ) 7 × 7 F N ( t ) 7 × 15 0 15 × 7 0 15 × 15
其中:FM(t)7×7建立了导航误差之间的关系,FN(t)7×15建立了导航误差与传感器误差之间的关系;
F M ( t ) 7 × 7 = 0 2 Ω U 0 0 0 - g g - 2 Ω U 0 0 0 g 0 - g 0 1 R M 0 0 0 0 0 sec L R N 0 0 0 0 0 0 0 - 1 R M 0 0 0 Ω U - Ω N 1 R N 0 - Ω U 0 - Ω U 0 0 tan L R N 0 Ω N 0 Ω N 0 0
F N ( t ) 7 × 15 = 0 3 × 3 F N ( t ) 2 × 3 2 F N ( t ) 2 × 3 3 F N ( t ) 2 × 3 4 F N ( t ) 2 × 3 5 0 2 × 3 0 2 × 3 0 2 × 3 0 2 × 3 0 2 × 3 F N ( t ) 3 × 3 1 0 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3
F N ( t ) 3 × 3 1 = C p n , F N ( t ) 2 × 3 2 = C 11 C 12 C 13 C 21 C 22 C 23 , F N ( t ) 2 × 3 3 = C 11 m 11 C 11 m 12 C 11 m 13 C 21 m 11 C 21 m 12 C 21 m 13 ,
F N ( t ) 2 × 3 4 = C 12 m 21 C 12 m 22 C 12 m 23 C 22 m 21 C 22 m 22 C 22 m 23 , F N ( t ) 2 × 3 5 = C 13 m 31 C 13 m 32 C 13 m 33 C 23 m 31 C 23 m 32 C 23 m 33 ,
M = - ( ω i p y p ) 2 - ( ω i p z p ) 2 - ω · i p z p + ω i p x p ω i p y p ω · i p y p + ω i p x p ω i p z p ω · i p z p + ω i p x p ω i p y p - ( ω i p z p ) 2 - ( ω i p x p ) 2 - ω · i p x p + ω i p y p ω i p z p - ω · i p y p + ω i p x p ω i p z p ω · i p x p + ω i p y p ω i p z p - ( ω i p x p ) 2 - ( ω i p y p ) 2
其中,ΩN,ΩU表示地球自转沿北向和天向的分量,RM,RN都表示地球半径,L表示当地纬度,g表示重力加速度。表示m行n列的分块矩阵,q表示非零分块矩阵的序号,0m×n表示m行n列的零矩阵,p代表惯性平台坐标系,n代表东-北-天地理系,是p系到n系的坐标变换阵,M矩阵建立了内杆臂参数与加速度误差之间的关系,M={mij},i,j=1,2,3, 代表陀螺敏感到的角速度信息,代表差分得到的角加速度信息;卡尔曼滤波模型以东向和北向的速度误差作为观测量,观测方程写为:
H=[I2×2 02×20]
其中,可观测矩阵H为常值矩阵,I2×2表示2阶单位矩阵;
根据卡尔曼滤波的基本方程,选择滤波初值,执行卡尔曼滤波过程,在旋转方案执行完毕后,得到加速度计内杆臂参数的估计结果。
4.根据权利要求1所述的用于混合式惯导系统的加速度计内杆臂标定与补偿方法,其特征在于:所述步骤四中:补偿方案如下:
f i p x p = f ~ i p x p - [ - ( ( ω i p y p ) 2 + ( ω i p z p ) 2 ) r x x p - ( ω · i p z p - ω i p x p ω i p y p ) r x y p + ( ω · i p y p + ω i p x p ω i p z p ) r x z p ]
f i p y p = f ~ i p y p - [ ( ω · i p z p + ω i p x p ω i p y p ) r y x p - ( ( ω i p z p ) 2 + ( ω i p x p ) 2 ) r y y p - ( ω · i p x p - ω i p y p ω i p z p ) r y z p ]
f i p z p = f ~ i p z p - [ - ( ω · i p y p - ω i p x p ω i p z p ) r z x p + ( ω · i p x p + ω i p y p ω i p z p ) r z y p - ( ( ω i p x p ) 2 + ( ω i p y p ) 2 ) r z z p ]
其中,分别为补偿前的x,y,z加速度计输出,分别为补偿后的x,y,z加速度计输出。
5.根据权利要求1-4任意之一所述的用于混合式惯导系统的加速度计内杆臂标定与补偿方法,其特征在于:对于不含三轴框架的惯导系统,可借助高精度的三轴数控转台实现本发明所述的变角速度旋转方案,从而实现该惯导系统的加速度计内杆臂标定与补偿,也可推广应用于不含三轴框架的惯导系统中。
CN201611063512.8A 2016-11-25 2016-11-25 一种用于混合式惯导系统的加速度计内杆臂标定与补偿方法 Active CN106482746B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201611063512.8A CN106482746B (zh) 2016-11-25 2016-11-25 一种用于混合式惯导系统的加速度计内杆臂标定与补偿方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201611063512.8A CN106482746B (zh) 2016-11-25 2016-11-25 一种用于混合式惯导系统的加速度计内杆臂标定与补偿方法

Publications (2)

Publication Number Publication Date
CN106482746A true CN106482746A (zh) 2017-03-08
CN106482746B CN106482746B (zh) 2019-04-26

Family

ID=58275275

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201611063512.8A Active CN106482746B (zh) 2016-11-25 2016-11-25 一种用于混合式惯导系统的加速度计内杆臂标定与补偿方法

Country Status (1)

Country Link
CN (1) CN106482746B (zh)

Cited By (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106767806A (zh) * 2017-04-01 2017-05-31 北京航空航天大学 一种用于混合式惯性导航系统的物理平台
CN107270905A (zh) * 2017-07-13 2017-10-20 中国人民解放军63820部队吸气式高超声速技术研究中心 一种静基座下惯性平台连续翻滚自标定自对准方法
CN108318052A (zh) * 2018-01-24 2018-07-24 北京航天控制仪器研究所 一种基于双轴连续旋转的混合式平台惯导系统标定方法
CN108592952A (zh) * 2018-06-01 2018-09-28 北京航空航天大学 基于杆臂补偿与正反倍速率同时标定多mimu误差的方法
CN110672124A (zh) * 2019-09-27 2020-01-10 北京耐威时代科技有限公司 离线杠杆臂估计方法
US20200408529A1 (en) * 2019-06-27 2020-12-31 DeepMap Inc. Calibration of inertial measurement units of vehicles using localization
CN113418535A (zh) * 2021-06-13 2021-09-21 西北工业大学 基于二维内杆臂估计的旋转惯导系统多位置对准方法
CN113447960A (zh) * 2020-03-26 2021-09-28 千寻位置网络有限公司 基于gnss/mems组合车载导航系统的误差标定方法及系统
CN113503895A (zh) * 2021-06-10 2021-10-15 北京自动化控制设备研究所 基于卡尔曼滤波的三自惯组加速度计尺寸估计方法

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20090089001A1 (en) * 2007-08-14 2009-04-02 American Gnc Corporation Self-calibrated azimuth and attitude accuracy enhancing method and system (SAAAEMS)
CN103363989A (zh) * 2012-04-09 2013-10-23 北京自动化控制设备研究所 一种捷联惯导系统内杆臂的估计与误差补偿方法
CN104697553A (zh) * 2015-03-13 2015-06-10 哈尔滨工程大学 光纤陀螺捷联惯导系统加速度计内杆臂标定方法
CN105973271A (zh) * 2016-07-25 2016-09-28 北京航空航天大学 一种混合式惯导系统自标定方法

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20090089001A1 (en) * 2007-08-14 2009-04-02 American Gnc Corporation Self-calibrated azimuth and attitude accuracy enhancing method and system (SAAAEMS)
CN103363989A (zh) * 2012-04-09 2013-10-23 北京自动化控制设备研究所 一种捷联惯导系统内杆臂的估计与误差补偿方法
CN104697553A (zh) * 2015-03-13 2015-06-10 哈尔滨工程大学 光纤陀螺捷联惯导系统加速度计内杆臂标定方法
CN105973271A (zh) * 2016-07-25 2016-09-28 北京航空航天大学 一种混合式惯导系统自标定方法

Non-Patent Citations (3)

* Cited by examiner, † Cited by third party
Title
严恭敏等: "捷联惯导系统内杆臂补偿方法及试验验证", 《宇航学报》 *
党建军等: "用杆臂效应在轨标定加速度计标度因数的方法", 《中国空间科学技术》 *
周广涛等: "光纤捷联惯导系统加速度计内杆臂标定方法", 《压电与声光》 *

Cited By (15)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106767806A (zh) * 2017-04-01 2017-05-31 北京航空航天大学 一种用于混合式惯性导航系统的物理平台
CN107270905A (zh) * 2017-07-13 2017-10-20 中国人民解放军63820部队吸气式高超声速技术研究中心 一种静基座下惯性平台连续翻滚自标定自对准方法
CN107270905B (zh) * 2017-07-13 2019-08-27 中国人民解放军63820部队吸气式高超声速技术研究中心 一种静基座下惯性平台连续翻滚自标定自对准方法
CN108318052B (zh) * 2018-01-24 2020-08-14 北京航天控制仪器研究所 一种基于双轴连续旋转的混合式平台惯导系统标定方法
CN108318052A (zh) * 2018-01-24 2018-07-24 北京航天控制仪器研究所 一种基于双轴连续旋转的混合式平台惯导系统标定方法
CN108592952A (zh) * 2018-06-01 2018-09-28 北京航空航天大学 基于杆臂补偿与正反倍速率同时标定多mimu误差的方法
CN108592952B (zh) * 2018-06-01 2020-10-27 北京航空航天大学 基于杆臂补偿与正反倍速率同时标定多mimu误差的方法
US20200408529A1 (en) * 2019-06-27 2020-12-31 DeepMap Inc. Calibration of inertial measurement units of vehicles using localization
US11835342B2 (en) * 2019-06-27 2023-12-05 Nvidia Corporation Calibration of inertial measurement units of vehicles using localization
CN110672124A (zh) * 2019-09-27 2020-01-10 北京耐威时代科技有限公司 离线杠杆臂估计方法
CN113447960A (zh) * 2020-03-26 2021-09-28 千寻位置网络有限公司 基于gnss/mems组合车载导航系统的误差标定方法及系统
CN113447960B (zh) * 2020-03-26 2022-06-24 千寻位置网络有限公司 基于gnss/mems组合车载导航系统的误差标定方法及系统
CN113503895A (zh) * 2021-06-10 2021-10-15 北京自动化控制设备研究所 基于卡尔曼滤波的三自惯组加速度计尺寸估计方法
CN113503895B (zh) * 2021-06-10 2023-08-15 北京自动化控制设备研究所 基于卡尔曼滤波的三自惯组加速度计尺寸估计方法
CN113418535A (zh) * 2021-06-13 2021-09-21 西北工业大学 基于二维内杆臂估计的旋转惯导系统多位置对准方法

Also Published As

Publication number Publication date
CN106482746B (zh) 2019-04-26

Similar Documents

Publication Publication Date Title
CN106482746B (zh) 一种用于混合式惯导系统的加速度计内杆臂标定与补偿方法
CN108318052B (zh) 一种基于双轴连续旋转的混合式平台惯导系统标定方法
CN108180925B (zh) 一种里程计辅助车载动态对准方法
CN103808331B (zh) 一种mems三轴陀螺仪误差标定方法
CN100516775C (zh) 一种捷联惯性导航系统初始姿态确定方法
CN104181574B (zh) 一种捷联惯导系统/全球导航卫星系统组合导航滤波系统及方法
CN106969783B (zh) 一种基于光纤陀螺惯性导航的单轴旋转快速标定技术
CN103900565B (zh) 一种基于差分gps的惯导系统姿态获取方法
CN112595350B (zh) 一种惯导系统自动标定方法及终端
CN103575299B (zh) 利用外观测信息的双轴旋转惯导系统对准及误差修正方法
CN105371844B (zh) 一种基于惯性/天文互助的惯性导航系统初始化方法
CN102169184B (zh) 组合导航系统中测量双天线gps安装失准角的方法和装置
CN103076025B (zh) 一种基于双解算程序的光纤陀螺常值误差标定方法
CN105571578B (zh) 一种利用伪观测取代精密转台的原地旋转调制寻北方法
CN109931955B (zh) 基于状态相关李群滤波的捷联惯性导航系统初始对准方法
CN101216321A (zh) 捷联惯性导航系统的快速精对准方法
CN105806363B (zh) 基于srqkf的sins/dvl水下大失准角对准方法
CN105180968A (zh) 一种imu/磁强计安装失准角在线滤波标定方法
CN104764463B (zh) 一种惯性平台调平瞄准误差的自检测方法
CN109029500A (zh) 一种双轴旋转调制系统全参数自标定方法
CN102519485B (zh) 一种引入陀螺信息的二位置捷联惯性导航系统初始对准方法
CN103453917A (zh) 一种双轴旋转式捷联惯导系统初始对准与自标校方法
CN104697526A (zh) 用于农业机械的捷联惯导系统以及控制方法
CN103674064B (zh) 捷联惯性导航系统的初始标定方法
CN105091907A (zh) Sins/dvl组合中dvl方位安装误差估计方法

Legal Events

Date Code Title Description
C06 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