[发明专利]捷联惯导光纤陀螺系统级误差参数现场标定方法无效
申请号: | 201210052422.4 | 申请日: | 2012-03-02 |
公开(公告)号: | CN102607594A | 公开(公告)日: | 2012-07-25 |
发明(设计)人: | 高伟;盛宏媛;周广涛;宋明哲;奔粤阳;徐博;王秋莹;吴晓;张义;娄少锋 | 申请(专利权)人: | 哈尔滨工程大学 |
主分类号: | G01C25/00 | 分类号: | G01C25/00 |
代理公司: | 暂无信息 | 代理人: | 暂无信息 |
地址: | 150001 黑龙江省哈尔滨市南岗区*** | 国省代码: | 黑龙江;23 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | 本发明的目的在于提供捷联惯导光纤陀螺系统级误差参数现场标定方法,包括以下步骤,将光纤陀螺捷联惯性导航系统与姿态测量辅助器件联通,光纤陀螺捷联惯导系统进行初始对准,采集陀螺输出和姿态测量辅助设备的输出值,将光纤陀螺输出值转换为陀螺所在坐标系相对于惯性系的角速度将带入捷联惯导方程中,得到光纤陀螺相对当地地理坐标系的转换矩阵根据姿态测量辅助设备提供的实时姿态角,得到真实的姿态转换矩阵T,从而得到姿态误差矩阵和系统实时姿态误差角,将带入光纤陀螺系统级标定滤波的状态方程中,对各项误差参数进行估计,完成辨识。本发明在标定路径的选择上具有很强的灵活性,大大降低了滤波器状态方程的维数。 | ||
搜索关键词: | 捷联惯导 光纤 陀螺 系统 误差 参数 现场 标定 方法 | ||
【主权项】:
1.捷联惯导光纤陀螺系统级误差参数现场标定方法,其特征是:(1)将需标定的光纤陀螺捷联惯性导航系统与现场提供的姿态测量辅助器件通过数据传输电缆相联通,确保光纤陀螺输出角速度测量值与姿态测量辅助器件输出的载体姿态角一致,并能够被计算机保存;(2)光纤陀螺捷联惯导系统进行初始对准,确定陀螺所在坐标系的初始姿态,得到姿态四元数的初始值;(3)将光纤陀螺捷联惯导系统和姿态测量辅助设备按预先设定好的标定路径进行转动,采集陀螺输出和姿态测量辅助设备的输出值;(4)利用光纤陀螺出厂时提供的标度因数,将光纤陀螺输出值转换为陀螺所在坐标系相对于惯性系的角速度(5)将带入捷联惯导方程中,得到光纤陀螺相对当地地理坐标系的转换矩阵(6)根据姿态测量辅助设备提供的实时姿态角,得到真实的姿态转换矩阵T;(7)通过与T的乘积,得到姿态误差矩阵利用系统姿态误差角与姿态矩阵的关系得到系统实时姿态误差角Z=[φE φN φu]T。(8)将带入光纤陀螺系统级标定kalman滤波的状态方程中X ‾ · ( t ) = A ( t ) X ‾ ( t ) + G ( t ) W ‾ ( t ) ]]>= A 1 ( t ) A 2 ( t ) O 12 × 15 X ‾ 0 T X ‾ g T + G ( t ) W ‾ ( t ) ]]> 其中A 1 = 0 ω ie sin L - ω ie cos L - ω ie sin L 0 0 ω ie cos L 0 0 , ]]> L为标定场地的经度值,ωie为地球自转角速度,A 2 = C 11 C 12 C 13 C 11 ω ibx b C 12 ω iby b C 13 ω ibz b C 11 ω iby b - C 11 ω ibz b - C 12 ω ibx b C 12 ω ibz b C 13 ω ibx b - C 13 ω iby b C 21 C 22 C 23 C 21 ω ibx b C 22 ω iby b C 23 ω ibz b C 21 ω iby b - C 21 ω ibz b - C 22 ω ibx b C 22 ω ibz b C 23 ω ibx b - C 23 ω iby b C 31 C 32 C 33 C 31 ω ibx b C 32 ω iby b C 33 ω ibz b C 31 ω iby b - C 31 ω ibz b - C 32 ω ibx b C 32 ω ibz b C 33 ω ibx b - C 33 ω iby b , ]]> XO=[φE φN φu]T,Xg=[bgx bgy bgz Sgx Sgy Sgz Δxy Δxz Δyx Δyz Δzx Δzy],为待标定的光纤陀螺误差参数,bg为陀螺零漂,Sg为陀螺标度因数误差,Δ为陀螺安装误差,G ( t ) = C b n O 12 × 3 , ]]>W ‾ ( t ) = δϵ x b δϵ y b δϵ z b T ]]> 陀螺产生的随机噪声干扰;将Z=[φE φN φu]T带入滤波器观测方程中:Z(t)=HX(t)+V(t)V ( t ) = σγ σθ σψ ]]> 为系统观测白噪声;利用kalman滤波器原理,对Xg中各项误差参数进行估计,完成对光纤陀螺各项误差参数的辨识。
下载完整专利技术内容需要扣除积分,VIP会员可以免费下载。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于哈尔滨工程大学,未经哈尔滨工程大学许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/patent/201210052422.4/,转载请声明来源钻瓜专利网。