[发明专利]光纤陀螺捷联惯性导航系统的单轴转台标定方法有效
申请号: | 201010270939.1 | 申请日: | 2010-09-03 |
公开(公告)号: | CN102003968A | 公开(公告)日: | 2011-04-06 |
发明(设计)人: | 奔粤阳;吴晓;李倩;高伟;付建楠;王秋滢;盛宏媛;张义;车延庭;南兆君 | 申请(专利权)人: | 哈尔滨工程大学 |
主分类号: | G01C25/00 | 分类号: | G01C25/00;G01C21/18 |
代理公司: | 暂无信息 | 代理人: | 暂无信息 |
地址: | 150001 黑龙江省哈尔滨市南岗区*** | 国省代码: | 黑龙江;23 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | 本发明的目的在于提供光纤陀螺捷联惯性导航系统的单轴转台标定方法。将光纤陀螺捷联惯性导航系统放置于单轴转台上,光纤陀螺捷联惯性导航系统通电进行预热,采集光纤陀螺输出的角速度和和石英挠性加速度计输出的比力,之后将控制单轴转台绕其转动轴逆时针旋转90°三次,并采集每次光纤陀螺输出的角速度和和石英挠性加速度计输出的比力,进而得到惯性器件坐标系x、y、z轴光纤陀螺的漂移和以及惯性器件坐标系x、y、z轴石英挠性加速度计的零位偏值。利用单轴转台旋转不同的角位置,便可测量出光纤陀螺的漂移和石英挠性加速度计的零位偏值的方法,并且单轴转台标定成本低,步骤简单,标定时单轴转台放置于地面即可,无需试验室环境。 | ||
搜索关键词: | 光纤 陀螺 惯性 导航系统 转台 标定 方法 | ||
【主权项】:
1.光纤陀螺捷联惯性导航系统的单轴转台标定方法,其特征是:(1)将光纤陀螺捷联惯性导航系统放置于单轴转台上,光纤陀螺捷联惯性导航系统通电进行预热,然后采集陀螺仪和加速度计输出的数据;(2)记初始时刻光纤陀螺捷联惯性导航系统所在位置为a位置,在a位置采集300秒内光纤陀螺输出的角速度ωa(1),ωa(2),...ωa(N)和石英挠性加速度计输出的比力fa(1),fa(2),...fa(N),其中
h为光纤陀螺捷联惯性导航系统的采样周期,上角标a表示数据采集时光纤陀螺捷联惯性导航系统处在a位置;(3)由步骤(2)测量结果,得出a位置上光纤陀螺输出的角速度平均值ω a ‾ = ω a ( 1 ) + ω a ( 2 ) + . . . . . . + ω a ( N - 1 ) + ω a ( N ) N ]]> 和石英挠性加速度计输出的比力平均值f a ‾ = f a ( 1 ) + f a ( 2 ) + . . . . . . + f a ( N - 1 ) + f a ( N ) N , ]]>
的惯性器件坐标系投影形式为ω a ‾ = ω x a ‾ ω y a ‾ ω z a ‾ , ]]>
的惯性器件坐标系投影形式为f a ‾ = f x a ‾ f y a ‾ f z a ‾ , ]]> 下角标x表示惯性器件坐标系x轴,y表示惯性器件坐标系y轴,z表示惯性器件坐标系z轴;(4)控制单轴转台绕其转动轴逆时针旋转90°,记转动后光纤陀螺捷联惯性导航系统所在位置为b位置,在b位置采集300秒内光纤陀螺输出的角速度ωb(1),ωb(2),...ωb(N)和石英挠性加速度计输出的比力fb(1),fb(2),...fb(N),上角标b表示数据采集时,光纤陀螺捷联惯性导航系统处在b位置;(5)由步骤(4)测量结果,得出b位置上光纤陀螺的输出的角速度平均值ω b ‾ = ω b ( 1 ) + ω b ( 2 ) + . . . . . . + ω b ( N - 1 ) + ω b ( N ) N ]]> 和石英挠性加速度计输出的比力平均值f b ‾ = f b ( 1 ) + f b ( 2 ) + . . . . . . + f b ( N - 1 ) + f b ( N ) N , ]]>
的惯性器件坐标系投影形式为ω b ‾ = ω x b ‾ ω y b ‾ ω z b ‾ , ]]>
的惯性器件坐标系投影形式为f b ‾ = f x b ‾ f y b ‾ f z b ‾ ; ]]> (6)控制单轴转台绕其转动轴逆时针旋转90°,记转动后光纤陀螺捷联惯性导航系统所在位置为c位置,在c位置采集300秒内光纤陀螺输出的角速度ωc(1),ωc(2),...ωc(N)和石英挠性加速度计输出的比力fc(1),fc(2),...fc(N),上角标c表示数据采集时光纤陀螺捷联惯性导航系统处在c位置;(7)由步骤(6)测量结果,得出c位置上光纤陀螺的输出的角速度平均值ω c ‾ = ω c ( 1 ) + ω c ( 2 ) + . . . . . . + ω c ( N - 1 ) + ω c ( N ) N ]]> 和石英挠性加速度计输出的比力平均值f c ‾ = f c ( 1 ) + f c ( 2 ) + . . . . . . + f c ( N - 1 ) + f c ( N ) N , ]]>
的惯性器件坐标系投影形式为ω c ‾ = ω x c ‾ ω y c ‾ ω z c ‾ , ]]>
的惯性器件坐标系投影形式为f c ‾ = f x c ‾ f y c ‾ f z c ‾ ; ]]> (8)控制单轴转台绕其转动轴逆时针旋转90°,记转动后光纤陀螺捷联惯性导航系统所在位置为d位置,在d位置采集300秒内光纤陀螺输出的角速度ωd(1),ωd(2),...ωd(N),和石英挠性加速度计输出的比力fd(1),fd(2),...fd(N),上角标d表示数据采集时光纤陀螺捷联惯性导航系统处在d位置;(9)由步骤(8)测量结果,得出c位置上光纤陀螺的输出的角速度平均值ω d ‾ = ω d ( 1 ) + ω d ( 2 ) + . . . . . . + ω d ( N - 1 ) + ω d ( N ) N ]]> 和石英挠性加速度计输出的比力平均值f d ‾ = f d ( 1 ) + f d ( 2 ) + . . . . . . + f d ( N - 1 ) + f d ( N ) N , ]]>
的惯性器件坐标系投影形式为ω d ‾ = ω x d ‾ ω y d ‾ ω z d ‾ , ]]>
的惯性器件坐标系投影形式为f d ‾ = f x d ‾ f y d ‾ f z d ‾ ; ]]> (10)由步骤(3)、步骤(5)、步骤(7)、步骤(9)测量得到惯性器件坐标系x轴光纤陀螺的漂移ϵ x = ω x a ‾ + ω x b ‾ + ω x c ‾ + ω x d ‾ 4 , ]]> 惯性器件坐标系y轴光纤陀螺的漂移ϵ y = ω y a ‾ + ω y b ‾ + ω y c ‾ + ω y d ‾ 4 , ]]> 以及惯性器件坐标系x轴石英挠性加速度计的零位偏值▿ x = f x a ‾ + f x b ‾ + f x c ‾ + f x d ‾ 4 , ]]> 惯性器件坐标系y轴石英挠性加速度计的零位偏值▿ y = f y a ‾ + f y b ‾ + f y c ‾ + f y d ‾ 4 , ]]> (11)由步骤(3)、步骤(5)、步骤(7)、步骤(9)和步骤(10)得到以下参量:在位置a时,光纤陀螺捷联惯性导航系统的纵摇角θθ = arcsin [ ( f y c ‾ - f y a ‾ ) 2 g ] + arcsin [ ( f x b ‾ - f x d ‾ ) 2 g ] 2 ]]> 其中g为光纤陀螺捷联惯性导航系统所在位置的重力值,进一步得到在位置a时,光纤陀螺捷联惯性导航系统的横摇角γγ = arcsin [ ( f x a ‾ - ▿ x ) g cos ( θ ) ] + arcsin [ ( f y b ‾ - ▿ y ) g cos ( θ ) ] 2 ]]> 进一步得到在位置a时,光纤陀螺捷联惯性导航系统的航向角φφ = arccos [ ( ω y a ‾ - ϵ y ) Ω cos L cos θ - tan L tan θ ] + arccos [ ( ω x b ‾ - ϵ x ) Ω cos L cos θ - tan L tan θ ] 2 ]]> 其中L为光纤陀螺捷联惯性导航系统所在位置的纬度值,Ω为地球自转角速度;(12)由步骤(3)、步骤(5)、步骤(7)、步骤(9)、步骤(10)和步骤(11)测量得到惯性器件坐标系z轴光纤陀螺的漂移ϵ z = ω z a ‾ + ω z b ‾ + ω z c ‾ + ω z d ‾ 4 - Ω [ cos L ( sin γ sin φ - cos γ sin θ cos φ ) + sin L cos γ cos θ ] ]]> 惯性器件坐标系z轴石英挠性加速度计的零位偏值▿ z = f z a ‾ + f z b ‾ + f z c ‾ + f z d ‾ 4 + g cos γ cos θ . ]]>
下载完整专利技术内容需要扣除积分,VIP会员可以免费下载。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于哈尔滨工程大学,未经哈尔滨工程大学许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/patent/201010270939.1/,转载请声明来源钻瓜专利网。