CN106248078A - 机抖激光陀螺敏感轴动态偏移误差参数估计与补偿方法 - Google Patents
机抖激光陀螺敏感轴动态偏移误差参数估计与补偿方法 Download PDFInfo
- Publication number
- CN106248078A CN106248078A CN201610543153.XA CN201610543153A CN106248078A CN 106248078 A CN106248078 A CN 106248078A CN 201610543153 A CN201610543153 A CN 201610543153A CN 106248078 A CN106248078 A CN 106248078A
- Authority
- CN
- China
- Prior art keywords
- epsiv
- omega
- centerdot
- gyroscope
- tau
- 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
Links
- 238000000034 method Methods 0.000 title claims abstract description 24
- 238000002474 experimental method Methods 0.000 claims description 13
- 238000009434 installation Methods 0.000 claims description 8
- 239000011159 matrix material Substances 0.000 claims description 7
- 230000009471 action Effects 0.000 claims description 6
- 125000004432 carbon atom Chemical group C* 0.000 claims description 6
- 238000013016 damping Methods 0.000 claims description 6
- 230000004044 response Effects 0.000 claims description 5
- 230000003068 static effect Effects 0.000 claims description 5
- 238000006880 cross-coupling reaction Methods 0.000 claims description 4
- 238000005259 measurement Methods 0.000 claims description 4
- 230000001133 acceleration Effects 0.000 claims description 3
- 230000010354 integration Effects 0.000 claims description 3
- 230000003287 optical effect Effects 0.000 claims description 3
- 230000000694 effects Effects 0.000 abstract description 9
- 238000010586 diagram Methods 0.000 description 4
- 238000004364 calculation method Methods 0.000 description 3
- 239000006096 absorbing agent Substances 0.000 description 2
- 238000005452 bending Methods 0.000 description 2
- 238000013461 design Methods 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 230000007246 mechanism Effects 0.000 description 2
- 238000012795 verification Methods 0.000 description 2
- 238000004458 analytical method Methods 0.000 description 1
- 230000007123 defense Effects 0.000 description 1
- 238000002955 isolation Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000005457 optimization Methods 0.000 description 1
- 230000008569 process Effects 0.000 description 1
- 230000009467 reduction Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 230000035939 shock Effects 0.000 description 1
- 238000004088 simulation Methods 0.000 description 1
- 238000001228 spectrum Methods 0.000 description 1
- 238000012360 testing method Methods 0.000 description 1
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
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
技术领域:
本发明涉及一种机抖激光陀螺误差参数估计与补偿方法,特别涉及一种机抖激光陀螺敏感轴动态偏移误差参数估计与补偿方法,属于惯性导航领域。
背景技术:
机抖激光陀螺的基本原理是萨格纳(Sagnac)效应,并以其特有的优势在捷联式惯性导航系统中得到了广泛应用。机抖激光陀螺在实际使用中存在闭锁效应,因此需要通过抖动机构(抖轮)给整个陀螺腔体施加高频角振动,使得激光陀螺在锁区内停留的时间极短,进而保证激光陀螺的测量精度。
但是由于存在抖轮这个活动部件,机抖激光陀螺在振动环境下会产生与振动相关的零偏,进而产生相应的姿态漂移,这种误差的产生与姿态解算的频率无关,即使将姿态解算频率提高到4000Hz,姿态精度仍然没有得到改善。造成这种情况出现的原因实质上是由于活动部件抖轮的存在,机抖激光陀螺的敏感轴在振动环境下会发生动态偏移,造成等效安装误差,进而产生相应的角速度误差,影响姿态解算精度。针对振动环境下,机抖激光陀螺敏感轴发生动态偏移进而产生相应误差的情况,一般的解决方法是:1、优化系统的减振结构2、优化机抖激光陀螺抖轮结构,减小陀螺敏感轴动态偏移误差。
文献(“二频机抖激光陀螺单轴旋转惯性导航系统若干关键技术研究”,国防科学技术大学博士学位论文,2011年,于旭东)重新设计了机抖激光陀螺抖轮的结构,提高激光陀螺的抖频和侧向固有频率,使得单表级激光陀螺在振动环境下的精度有了明显改善,但是该文献没有给出振动环境下系统级精度测试情况。文献(“椭圆锥动效应对机械抖动激光陀螺振动特性的影响”,《中国惯性技术学报》,2015年4月,第23卷第2期,赵小宁等)对振动条件下椭圆锥动效应对机抖激光陀螺的影响进行了分析,指出增大抖轮的横向抗弯刚度可以改善振动条件下机抖激光陀螺的精度,但并未给出振动条件下系统级误差补偿方法。文献(“Drift error analysis caused by RLG dither axis bending”,Sensors andActuators A 133(2007)425-430,Kwangjin Kim,Chan Gook Park)理论推导了由机抖激光陀螺抖动轴弯曲变形造成的漂移误差,认为该误差与输入加速度及载体的动态频率成正比,并进行了仿真验证,但没有进一步的实验验证和误差补偿方法。
振动条件下机抖激光陀螺敏感轴发生动态偏移是造成捷联惯导系统精度下降的重要原因,目前公开的资料集中在优化机抖激光陀螺抖轮的设计,增大抖轮的侧向刚度,以期改善机抖激光陀螺单表级精度,未见有关于系统级机抖激光陀螺敏感轴动态偏移误差参数估计与补偿的方法,因此,寻找一种振动条件下机抖激光陀螺敏感轴动态偏移误差参数估计与补偿方法具有十分重要的意义。
发明内容:
本发明的目的是针对振动条件下机抖激光陀螺敏感轴发生动态偏移影响惯导系统精度的问题,提供了一种机抖激光陀螺敏感轴动态偏移误差参数估计与补偿方法,对振动条件下机抖激光陀螺敏感轴动态偏移造成的误差进行补偿,改善惯导系统的精度。
本发明的目的通过以下技术方案来实现:
一种机抖激光陀螺敏感轴动态偏移误差参数估计与补偿方法,该方法包括以下步骤:
步骤一,建立机抖激光陀螺敏感轴动态偏移形变角的动力学方程:
根据欧拉定理,外力矩作用下,机抖激光陀螺敏感轴动态偏移形变角的动力学方程为,
上式中,
Jx=Jy=Jz=J为x陀螺、y陀螺、z陀螺绕其各自敏感轴方向的转动惯量;
Jxy≈Jxz≈Jyx≈Jyz≈Jzx≈Jzy≈J1为x陀螺、y陀螺、z陀螺绕与其敏感轴正交的对称轴的转动惯量;
cxy≈cxz≈cyx≈cyz≈czx≈czy≈c为陀螺抖轮的侧向形变阻尼;
kxy、kxz、kyx、kyz、kzx、kzy分别为各个陀螺抖轮的侧向刚度,m为陀螺光学本体的质量;
[lxx lxy lxz]T、[lyx lyy lyz]T、[lzx lzy lzz]T分别为x陀螺、y陀螺、z陀螺质心偏离的杆臂参数;
ωdx、ωdy、ωdz分别为x陀螺、y陀螺、z陀螺的抖动角速率;
步骤二,简化机抖激光陀螺敏感轴动态偏移形变角的动力学方程:
同一陀螺不同方向的侧向刚度非常接近,可以忽略非等弹性的影响,即,
kxz≈kxy=kx,kyz≈kyx=ky,kzx≈kzy=kz (2)
鉴于机抖激光陀螺侧向形变阻尼的存在,忽略交叉耦合项的影响,同时忽略外界角加速度的影响(其影响等价于动力学方程的外界输入),只考虑偏心力矩对陀螺敏感轴侧向形变的影响,同时考虑到机抖激光陀螺侧向形变的固有频率一般在700Hz以上(远高于作用于机抖激光陀螺的偏心力矩频率),得到机抖激光陀螺敏感轴动态偏移形变角动力学方程的简化解(即(1)式的稳态响应近似解)为,
上式中,
步骤三,建立机抖激光陀螺敏感轴动态偏移误差模型:
设机抖激光陀螺捷联惯导系统IMU(Inertial Measurement Unit)的x陀螺敏感轴为x轴,y陀螺敏感轴为y轴,z陀螺敏感轴为z轴;设εxy、εxz分别为x陀螺敏感轴绕y轴、z轴转动的形变角,εyx、εyz分别为y陀螺敏感轴绕x轴、z轴转动的形变角,εzx、εzy分别为z陀螺敏感轴绕x轴、y轴转动的形变角;无外部力学环境作用下,以x陀螺敏感轴为基准,εyz0为y陀螺敏感轴绕z轴转动的常值偏角;εzx0、εzy0分别为z陀螺敏感轴绕x轴、y轴转动的常值偏角,则动态情况下敏感轴动态偏移造成的等效陀螺漂移误差模型可表示为,
上式中,第一项为陀螺敏感轴常值偏角、动态偏移形变角对应的等效安装偏差造成的动态误差,第二项为陀螺敏感轴动态偏移形变角对应的等效圆锥误差;
考虑到式(4)中陀螺敏感轴常值偏角是陀螺安装参数的一部分,可以通过标定消除;忽略非等弹性影响时,陀螺敏感轴动态偏移形变角对应的等效圆锥误差也很小,可以忽略;进一步根据式(3),将式(4)简化为:
式(5)即机抖激光陀螺敏感轴动态偏移误差简化模型;
步骤四,机抖激光陀螺敏感轴动态偏移误差模型参数估计:
在固定位置处,对惯导系统施以固定频率线振动,机抖激光陀螺敏感轴动态偏移形变会产生等效陀螺漂移,相对地理系造成的姿态误差微分方程表示为,
记时刻t0为线振动开始时刻,振动持续时间记为T,则t0+T时刻的姿态误差为,
将式(5)代入上式,
其中,
忽略对准造成的姿态误差,时刻t0的姿态误差记为ψn(t0)=0,通过数值积分获得式(9)的数值解,该数值解表示为τ的确定形式;t0+T时刻线振动结束,惯导静止一段时间进行对准,利用此姿态基准获得t+T时刻的姿态误差观测值,为:
其中,为姿态误差观测值,为惯导系统从时刻t0至时刻t0+T时间段内解算得到的姿态矩阵,为线振动结束后惯导系统再次对准得到的姿态参考矩阵;
根据式(9)、(10),设计多组线振动实验,利用最小二乘法实现九个误差参数的估计;
步骤五,机抖激光陀螺敏感轴动态偏移误差补偿:
利用步骤四中估计得到的误差参数τ,并根据机抖激光陀螺敏感轴动态偏移误差简化模型(5),对振动条件下机抖激光陀螺敏感轴动态偏移误差按如下方式进行补偿,
其中,为带有误差的陀螺实测角速度,为误差补偿量,为真实角速度。
本发明具有以下技术效果:
1)本发明建立了机抖激光陀螺敏感轴动态偏移误差模型,明确了误差机理,通过对误差参数的估计,能够实现振动条件下机抖激光陀螺敏感轴动态偏移误差的有效补偿;
2)本发明作为系统级补偿方法,可以用于振动条件下机抖激光陀螺敏感轴动态偏移误差的实时补偿;
3)本发明可进一步应用于大过载、高机动条件下,机抖激光陀螺惯导系统的误差补偿。
附图说明:
1.图1是机抖激光陀螺敏感轴动态偏移误差参数估计与补偿方法流程图;
2.图2是X-Y面水平时线振动实验示意图;
3.图3是X-Z面水平时线振动实验示意图;
4.图4是初步补偿结果对比示意图。
具体实施方式:
下面结合附图对本发明中的方法做进一步详细阐述:
步骤一,建立机抖激光陀螺敏感轴动态偏移形变角的动力学方程:
根据欧拉定理,外力矩作用下,机抖激光陀螺敏感轴动态偏移形变角的动力学方程为,
上式中,
Jx=Jy=Jz=J为x陀螺、y陀螺、z陀螺绕其各自敏感轴方向的转动惯量;
Jxy≈Jxz≈Jyx≈Jyz≈Jzx≈Jzy≈J1为x陀螺、y陀螺、z陀螺绕与其敏感轴正交的对称轴的转动惯量;
cxy≈cxz≈cyx≈cyz≈czx≈czy≈c为陀螺抖轮的侧向形变阻尼;
kxy、kxz、kyx、kyz、kzx、kzy分别为各个陀螺抖轮的侧向刚度,m为陀螺光学本体的质量;
[lxx lxy lxz]T、[lyx lyy lyz]T、[lzx lzy lzz]T分别为x陀螺、y陀螺、z陀螺质心偏离的杆臂参数;
ωdx、ωdy、ωdz分别为x陀螺、y陀螺、z陀螺的抖动角速率;
步骤二,简化机抖激光陀螺敏感轴动态偏移形变角的动力学方程:
同一陀螺不同方向的侧向刚度非常接近,可以忽略非等弹性的影响,即,
kxz≈kxy=kx,kyz≈kyx=ky,kzx≈kzy=kz(13)
为便于实际工程应用,对式(12)进行简化,以x陀螺为例进行说明;考虑到x陀螺沿y、z方向形变阻尼的影响,忽略交叉耦合项的影响,同时忽略的影响(其影响等价于动力学方程的外界输入),只考虑偏心力矩对x陀螺敏感轴侧向形变的影响,x陀螺的动力学方程可以简化为,
假设作用到x陀螺上的等效偏心力矩为正弦力矩Mcos(ωt),由于减振器对高频振动的隔离,实际作用于陀螺的偏心力矩的频谱集中于低频段,鉴于陀螺敏感轴侧向形变的固有频率一般在700Hz以上,则有,
同时考虑到则x陀螺侧向形变稳态响应的近似解为:
同理,可得y、z陀螺侧向形变的稳态响应近似解,式(12)所示动力学方程的稳态响应近似解为:
上式中,
步骤三,建立机抖激光陀螺敏感轴动态偏移误差模型:
设机抖激光陀螺捷联惯导系统IMU(Inertial Measurement Unit)的x陀螺敏感轴为x轴,y陀螺敏感轴为y轴,z陀螺敏感轴为z轴;设εxy、εxz分别为x陀螺敏感轴绕y轴、z轴转动的形变角,εyx、εyz分别为y陀螺敏感轴绕x轴、z轴转动的形变角,εzx、εzy分别为z陀螺敏感轴绕x轴、y轴转动的形变角;无外部力学环境作用下,以x陀螺敏感轴为基准,εyz0为y陀螺敏感轴绕z轴转动的常值偏角;εzx0、εzy0分别为z陀螺敏感轴绕x轴、y轴转动的常值偏角,则动态情况下敏感轴动态偏移造成的等效陀螺漂移误差模型可表示为,
上式中,第一项为陀螺敏感轴常值偏角、动态偏移形变角对应的等效安装偏差造成的动态误差,第二项为陀螺敏感轴动态偏移形变角对应的等效圆锥误差;
考虑到式(18)中陀螺敏感轴常值偏角是陀螺安装参数的一部分,可以通过标定消除;忽略非等弹性影响时,陀螺敏感轴动态偏移形变角对应的等效圆锥误差也很小,可以忽略;进一步根据式(17),将式(18)简化为:
式(19)即机抖激光陀螺敏感轴动态偏移误差简化模型;
步骤四,机抖激光陀螺敏感轴动态偏移误差模型参数估计:
在固定位置处,对惯导系统施以固定频率线振动,机抖激光陀螺敏感轴动态偏移形变会产生等效陀螺漂移,相对地理系造成的姿态误差微分方程表示为,
记时刻t0为线振动开始时刻,振动持续时间记为T,则t0+T时刻的姿态误差为,
将式(19)代入上式,
其中,
忽略对准造成的姿态误差,时刻t0的姿态误差记为ψn(t0)=0,通过数值积分获得式(23)的数值解,该数值解表示为τ的确定形式;t0+T时刻线振动结束,惯导静止一段时间进行对准,利用此姿态基准获得t+T时刻的姿态误差观测值,为:
其中,为姿态误差观测值,为惯导系统从时刻t0至时刻t0+T时间段内解算得到的姿态矩阵,为线振动结束后惯导系统再次对准得到的姿态参考矩阵;
根据式(23)、(24),设计多组线振动实验,利用最小二乘法实现九个误差参数的估计;
参数估计过程需要充分激励误差,不同振动实验条件下,可以对不同的待辨识参数造成的误差进行充分激励;从式(19)可以看出,比力与角速率乘积项耦合,产生等效漂移,据此,可以设计线振动实验对待辨识参数进行标定估计;
线振动实验设计:为了使得惯导系统在线振动条件下同时存在较大的角运动,需要在惯导系统安装底座的下部加装外减振器,之后将系统固联到振动台上,进而分别沿惯导系统的两个水平轴向、两个对角线方向进行固定频率线振动实验(图2所示);第一组次实验完成后,绕惯导系统的X轴或Y轴转动90°将Z轴转动至线振动台水平面内,进而分别沿惯导系统的两个水平轴向、两个对角线方向进行固定频率线振动实验(图3所示);这样便实现了陀螺在各个方向误差参数的充分激励;
步骤五,机抖激光陀螺敏感轴动态偏移误差补偿:
利用步骤四中估计得到的误差参数τ,并根据机抖激光陀螺敏感轴动态偏移误差简化模型(19),对振动条件下机抖激光陀螺敏感轴动态偏移误差按如下方式进行补偿,
其中,为带有误差的陀螺实测角速度,为误差补偿量,为真实角速度。
按照以上发明方法,对振动条件下某90型机抖激光陀螺敏感轴动态偏移误差参数进行估计,同时考察误差补偿效果。
在振幅为2g,频率为20Hz正弦线振动条件下,按照误差模型和误差参数估计方法对某90型机抖激光陀螺捷联惯导系统待辨识参数进行估计,得到未知参数值。每组振动实验按照以下顺序组织:惯导系统首先静止10min,然后振动10min,最后再次静止10min。考虑到t0+T时刻的姿态参考矩阵的航向角误差受等效东向陀螺漂移的影响较大,t0+T时刻的姿态误差参考值只取水平姿态角误差。将辨识得到的参数用于振幅为2g,频率为40Hz的正弦线振动实验误差补偿,验证误差模型的补偿效果,图4给出了补偿前后的速度误差对比示意图,机抖激光陀螺敏感轴动态偏移误差补偿后,10min线振动时间内,系统纯惯导精度提高30%以上。
以上仅是本发明的优选实施方式,本发明的保护范围并不仅局限于上述实施例,凡属于本发明思路下的技术方案均属于本发明的保护范围。应当指出,对于本技术领域的普通技术人员来说,在不脱离本发明原理前提下的若干改进和润饰,应视为本发明的保护范围。
Claims (1)
1.机抖激光陀螺敏感轴动态偏移误差参数估计与补偿方法,其特征在于,该方法包括以下步骤:
步骤一,建立机抖激光陀螺敏感轴动态偏移形变角的动力学方程:
根据欧拉定理,外力矩作用下,机抖激光陀螺敏感轴动态偏移形变角的动力学方程为,
上式中,
Jx=Jy=Jz=J为x陀螺、y陀螺、z陀螺绕其各自敏感轴方向的转动惯量;
Jxy≈Jxz≈Jyx≈Jyz≈Jzx≈Jzy≈J1为x陀螺、y陀螺、z陀螺绕与其敏感轴正交的对称轴的转动惯量;
cxy≈cxz≈cyx≈cyz≈czx≈czy≈c为陀螺抖轮的侧向形变阻尼;
kxy、kxz、kyx、kyz、kzx、kzy分别为各个陀螺抖轮的侧向刚度,m为陀螺光学本体的质量;
[lxx lxy lxz]T、[lyx lyy lyz]T、[lzx lzy lzz]T分别为x陀螺、y陀螺、z陀螺质心偏离的杆臂参数;
ωdx、ωdy、ωdz分别为x陀螺、y陀螺、z陀螺的抖动角速率;
步骤二,简化机抖激光陀螺敏感轴动态偏移形变角的动力学方程:
同一陀螺不同方向的侧向刚度非常接近,可以忽略非等弹性的影响,即,
kxz≈kxy=kx,kyz≈kyx=ky,kzx≈kzy=kz (2)
鉴于机抖激光陀螺侧向形变阻尼的存在,忽略交叉耦合项的影响,同时忽略外界角加速度的影响(其影响等价于动力学方程的外界输入),只考虑偏心力矩对陀螺敏感轴侧向形变的影响,同时考虑到机抖激光陀螺侧向形变的固有频率一般在700Hz以上(远高于作用于机抖激光陀螺的偏心力矩频率),得到机抖激光陀螺敏感轴动态偏移形变角动力学方程的简化解(即(1)式的稳态响应近似解)为,
上式中,
步骤三,建立机抖激光陀螺敏感轴动态偏移误差模型:
设机抖激光陀螺捷联惯导系统IMU(Inertial Measurement Unit)的x陀螺敏感轴为x轴,y陀螺敏感轴为y轴,z陀螺敏感轴为z轴;设εxy、εxz分别为x陀螺敏感轴绕y轴、z轴转动的形变角,εyx、εyz分别为y陀螺敏感轴绕x轴、z轴转动的形变角,εzx、εzy分别为z陀螺敏感轴绕x轴、y轴转动的形变角;无外部力学环境作用下,以x陀螺敏感轴为基准,εyz0为y陀螺敏感轴绕z轴转动的常值偏角;εzx0、εzy0分别为z陀螺敏感轴绕x轴、y轴转动的常值偏角,则动态情况下敏感轴动态偏移造成的等效陀螺漂移误差模型可表示为,
上式中,第一项为陀螺敏感轴常值偏角、动态偏移形变角对应的等效安装偏差造成的动态误差,第二项为陀螺敏感轴动态偏移形变角对应的等效圆锥误差;
考虑到式(4)中陀螺敏感轴常值偏角是陀螺安装参数的一部分,可以通过标定消除;忽略非等弹性影响时,陀螺敏感轴动态偏移形变角对应的等效圆锥误差也很小,可以忽略;进一步根据式(3),将式(4)简化为:
式(5)即机抖激光陀螺敏感轴动态偏移误差简化模型;
步骤四,机抖激光陀螺敏感轴动态偏移误差模型参数估计:
在固定位置处,对惯导系统施以固定频率线振动,机抖激光陀螺敏感轴动态偏移形变会产生等效陀螺漂移,相对地理系造成的姿态误差微分方程表示为,
记时刻t0为线振动开始时刻,振动持续时间记为T,则t0+T时刻的姿态误差为,
将式(5)代入上式,
其中,
τ=[τ0x τxy τxz τyx τyy τyz τzx τzy τzz]T
忽略对准造成的姿态误差,时刻t0的姿态误差记为ψn(t0)=0,通过数值积分获得式(9)的数值解,该数值解表示为τ的确定形式;t0+T时刻线振动结束,惯导静止一段时间进行对准,利用此姿态基准获得t+T时刻的姿态误差观测值,为:
其中,为姿态误差观测值,为惯导系统从时刻t0至时刻t0+T时间段内解算得到的姿态矩阵,为线振动结束后惯导系统再次对准得到的姿态参考矩阵;
根据式(9)、(10),设计多组线振动实验,利用最小二乘法实现九个误差参数的估计;
步骤五,机抖激光陀螺敏感轴动态偏移误差补偿:
利用步骤四中估计得到的误差参数τ,并根据机抖激光陀螺敏感轴动态偏移误差简化模型(5),对振动条件下机抖激光陀螺敏感轴动态偏移误差按如下方式进行补偿,
其中,为带有误差的陀螺实测角速度,为误差补偿量,为真实角速度。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610543153.XA CN106248078B (zh) | 2016-07-12 | 2016-07-12 | 机抖激光陀螺敏感轴动态偏移误差参数估计与补偿方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610543153.XA CN106248078B (zh) | 2016-07-12 | 2016-07-12 | 机抖激光陀螺敏感轴动态偏移误差参数估计与补偿方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106248078A true CN106248078A (zh) | 2016-12-21 |
CN106248078B CN106248078B (zh) | 2018-12-28 |
Family
ID=57613003
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610543153.XA Active CN106248078B (zh) | 2016-07-12 | 2016-07-12 | 机抖激光陀螺敏感轴动态偏移误差参数估计与补偿方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106248078B (zh) |
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108267156A (zh) * | 2017-12-20 | 2018-07-10 | 北京航天时代激光导航技术有限责任公司 | 激光惯组结构系统陀螺抖动性能确定方法 |
CN109141418A (zh) * | 2018-09-27 | 2019-01-04 | 东南大学 | 过载环境下捷联惯导数据处理装置及其多源误差建模方法 |
CN109631942A (zh) * | 2018-12-09 | 2019-04-16 | 西安航天精密机电研究所 | 石英加速度计输入轴失准角调平装置 |
CN110567452A (zh) * | 2019-07-31 | 2019-12-13 | 北京航空航天大学 | 一种激光陀螺双轴旋转惯导系统姿态误差补偿方法 |
CN111490819A (zh) * | 2020-03-13 | 2020-08-04 | 威海市赢海通信技术有限公司 | 基于光纤陀螺的舰载激光通信光束跟踪控制方法 |
CN111879321A (zh) * | 2020-08-01 | 2020-11-03 | 中国人民解放军国防科技大学 | 一种基于机抖激光陀螺的惯性/天文组合导航系统 |
CN115981167A (zh) * | 2023-03-21 | 2023-04-18 | 天津大学 | 扰动抑制系统 |
CN118010069A (zh) * | 2024-04-10 | 2024-05-10 | 四川图林科技有限责任公司 | 一种半球谐振陀螺仪的振动误差补偿方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR20070078334A (ko) * | 2006-01-26 | 2007-07-31 | 국방과학연구소 | 링 레이저 자이로스코프의 각진동 제거 방법 |
CN101566483A (zh) * | 2009-05-22 | 2009-10-28 | 哈尔滨工程大学 | 光纤陀螺捷联惯性测量系统振动误差补偿方法 |
CN104697550A (zh) * | 2013-12-10 | 2015-06-10 | 中国航空工业第六一八研究所 | 一种惯性导航系统实现免拆装精确自标定的方法 |
CN104977002A (zh) * | 2015-06-12 | 2015-10-14 | 同济大学 | 基于sins/双od的惯性组合导航系统及其导航方法 |
CN105628025A (zh) * | 2015-12-31 | 2016-06-01 | 中国人民解放军国防科学技术大学 | 一种恒速偏频/机抖激光陀螺惯导系统导航方法 |
-
2016
- 2016-07-12 CN CN201610543153.XA patent/CN106248078B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR20070078334A (ko) * | 2006-01-26 | 2007-07-31 | 국방과학연구소 | 링 레이저 자이로스코프의 각진동 제거 방법 |
CN101566483A (zh) * | 2009-05-22 | 2009-10-28 | 哈尔滨工程大学 | 光纤陀螺捷联惯性测量系统振动误差补偿方法 |
CN104697550A (zh) * | 2013-12-10 | 2015-06-10 | 中国航空工业第六一八研究所 | 一种惯性导航系统实现免拆装精确自标定的方法 |
CN104977002A (zh) * | 2015-06-12 | 2015-10-14 | 同济大学 | 基于sins/双od的惯性组合导航系统及其导航方法 |
CN105628025A (zh) * | 2015-12-31 | 2016-06-01 | 中国人民解放军国防科学技术大学 | 一种恒速偏频/机抖激光陀螺惯导系统导航方法 |
Non-Patent Citations (4)
Title |
---|
JUNCHAO CHENG 等: ""Optimized design method of vibration isolation system in mechanically dithered RLG POS based on motion decoupling"", 《MEASUREMENT》 * |
KWANGJIN KIM 等: ""Drift error analysis caused by RLG dither axis bending"", 《SENSORS & ACTUATORS: A. PHYSICAL》 * |
潘献飞,等: ""考虑机抖激光陀螺信号滤波特性的圆锥算法修正"", 《中国惯性技术学报》 * |
潘献飞: ""基于机抖激光陀螺信号频域特性的SINS动态误差分析与补偿算法研究"", 《中国博士学位论文全文数据库 工程科技Ⅱ辑》 * |
Cited By (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108267156B (zh) * | 2017-12-20 | 2020-03-24 | 北京航天时代激光导航技术有限责任公司 | 激光惯组结构系统陀螺抖动性能确定方法 |
CN108267156A (zh) * | 2017-12-20 | 2018-07-10 | 北京航天时代激光导航技术有限责任公司 | 激光惯组结构系统陀螺抖动性能确定方法 |
CN109141418A (zh) * | 2018-09-27 | 2019-01-04 | 东南大学 | 过载环境下捷联惯导数据处理装置及其多源误差建模方法 |
CN109631942A (zh) * | 2018-12-09 | 2019-04-16 | 西安航天精密机电研究所 | 石英加速度计输入轴失准角调平装置 |
CN109631942B (zh) * | 2018-12-09 | 2020-06-23 | 西安航天精密机电研究所 | 石英加速度计输入轴失准角调平装置 |
CN110567452B (zh) * | 2019-07-31 | 2021-04-23 | 北京航空航天大学 | 一种激光陀螺双轴旋转惯导系统姿态误差补偿方法 |
CN110567452A (zh) * | 2019-07-31 | 2019-12-13 | 北京航空航天大学 | 一种激光陀螺双轴旋转惯导系统姿态误差补偿方法 |
CN111490819A (zh) * | 2020-03-13 | 2020-08-04 | 威海市赢海通信技术有限公司 | 基于光纤陀螺的舰载激光通信光束跟踪控制方法 |
CN111879321A (zh) * | 2020-08-01 | 2020-11-03 | 中国人民解放军国防科技大学 | 一种基于机抖激光陀螺的惯性/天文组合导航系统 |
CN115981167A (zh) * | 2023-03-21 | 2023-04-18 | 天津大学 | 扰动抑制系统 |
CN115981167B (zh) * | 2023-03-21 | 2023-05-23 | 天津大学 | 扰动抑制系统 |
CN118010069A (zh) * | 2024-04-10 | 2024-05-10 | 四川图林科技有限责任公司 | 一种半球谐振陀螺仪的振动误差补偿方法 |
CN118010069B (zh) * | 2024-04-10 | 2024-06-11 | 四川图林科技有限责任公司 | 一种半球谐振陀螺仪的振动误差补偿方法 |
Also Published As
Publication number | Publication date |
---|---|
CN106248078B (zh) | 2018-12-28 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106248078B (zh) | 机抖激光陀螺敏感轴动态偏移误差参数估计与补偿方法 | |
Wang et al. | Estimation of information sharing error by dynamic deformation between inertial navigation systems | |
CN115143993B (zh) | 基于三轴转台的激光陀螺惯导系统g敏感性误差标定方法 | |
CN103630146B (zh) | 一种离散解析与Kalman滤波结合的激光陀螺IMU标定方法 | |
CN115060258B (zh) | 一种基于谐振惯导系统的卡尔曼滤波精对准方法 | |
CN102830242A (zh) | 一种基于磁悬浮惯性执行机构的姿态角速度测量方法 | |
CN114858184A (zh) | 一种半球谐振子参数辨识方法 | |
CN110631575B (zh) | 一种基于原子自旋陀螺仪的捷联系统 | |
CN114877915A (zh) | 一种激光陀螺惯性测量组件g敏感性误差标定装置及方法 | |
CN111006665B (zh) | 一种基于磁场反馈的原子自旋陀螺仪捷联系统 | |
CN104121930A (zh) | 一种基于加表耦合的mems陀螺漂移误差的补偿方法 | |
CN111637883B (zh) | 基于速度和位置误差闭环反馈的提高惯性制导精度的方法 | |
Xudong et al. | Suppression of the G-sensitive drift of laser gyro in dual-axis rotational inertial navigation system | |
CN104677356A (zh) | 一种基于角增量和比力输出的划桨速度计算方法 | |
CN111006664A (zh) | 一种基于原子自旋陀螺仪的三轴惯性平台系统 | |
Xu et al. | Influence of external load on hemispherical resonator gyro feedback control system with state constraints | |
Kim et al. | Drift error analysis caused by RLG dither axis bending | |
Wang et al. | Dynamic error compensation and parameter optimization for RLG SINS in vibration environments | |
Li et al. | A Dual-Axis Rotation Scheme for High-Precision RLG Inertial Navigation Systems Considering the G-Sensitive Misalignment | |
Wang et al. | RLG SINS dynamic error compensation under vibration environments | |
Terelyak | Simulation of the rate-integrating mode of operation of a micro-electro-mechanical gyroscope | |
Li et al. | An Efficient System-Level Calibration Method for a High-Precision RLG RINS Considering the G-Sensitive Misalignment | |
TWI411766B (zh) | Uniaxial Control Input Gyroscope System with Flaw Compensation. | |
Qin et al. | Design and analysis of dual-axis rotating scheme for ring laser strapdown inertial navigation system | |
Li et al. | Isotropic design method of suspension system of dithered RLG strapdown inertial measurement unit |
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 |