[发明专利]一种基于双轴转台的光学捷联惯导系统的标定方法无效
申请号: | 201210050032.3 | 申请日: | 2012-02-29 |
公开(公告)号: | CN102564461A | 公开(公告)日: | 2012-07-11 |
发明(设计)人: | 晁代宏;张小跃;丁枫;宋来亮;王涛 | 申请(专利权)人: | 北京航空航天大学 |
主分类号: | G01C25/00 | 分类号: | G01C25/00 |
代理公司: | 北京慧泉知识产权代理有限公司 11232 | 代理人: | 王顺荣;唐爱华 |
地址: | 100191*** | 国省代码: | 北京;11 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | 一种基于双轴转台的光学捷联惯导系统的标定方法,它有六大步骤:一、误差模型的选取;二、将惯导系统三轴朝向东北天方向安装到双轴转台上,整个系统连接通电预热后,采集数据;三:按照东北天、西南天、北东地、南西地、天南东、天北西、地北东、地南西、南天西、北天东、南地东、北地西十二位置,分别采集数据并存储到标定矩阵内;四、按照东北天、北西天两个位置,分别绕z、y、x以ω为±2°/s,±10°/s,±30°/s,±60°/s,±100°/s转动三分钟,将输出数据取均值存储到标定矩阵内;五:按照东北天、西南天、北东地、南西地四个位置,分别在每个位置上采集15分钟数据,并将输出数据取均值并存储到标定矩阵内;六、利用最小二乘法解算加速度计标定参数,利用解析法计算陀螺标定参数。 | ||
搜索关键词: | 一种 基于 转台 光学 捷联惯导 系统 标定 方法 | ||
【主权项】:
1.一种基于双轴转台的光学捷联惯导系统的标定方法,其特征在于:该方法具体布骤如下:步骤一:误差模型的选取;加速度计误差模型:f ax f ay f az = k axx k axy k axz k ayx k ayy k ayz k azx k azy k azz · A x A y A z + B ax B ay B az . . . ( 1 ) ]]> 陀螺误差模型:f gx f gy f gz = k gxx k gxy k gxz k gyx k gyy k gyz k gzx k gzy k gzz · ω x ω y ω z + B gx B gy B gz . . . ( 2 ) ]]> 其中fai、fgi分别为i轴加速度计、陀螺输出,Ai、ωi分别为i轴加速度计、陀螺输入,Bai、Bgi分别为i轴加速度计、陀螺零偏,kaii、kgii分别为输入i轴加速度计、陀螺单位输入在输出i轴上的投影,kaij、kgij分别为输入j轴加速度计、陀螺单位输入在输出i轴上的投影(i、j=x,y,z);步骤二:将惯导系统三轴朝向东北天方向安装到双轴转台上,转台、惯导系统、采集计算机连接完毕,通电预热30分钟后,进入数据采集过程;步骤三:按照十二位置即东北天、西南天、北东地、南西地、天南东、天北西、地北东、地南西、南天西、北天东、南地东、北地西位置,每个位置静态采集三分钟,并将数据取平均后,存储到标定矩阵内;步骤四:按照两个位置即东北天、北西天位置,分别绕z、y、x以ω为±2°/s,±10°/s,±30°/s,±60°/s,±100°/s转动三分钟,将输出数据取平均后存储到标定矩阵内;步骤五:按照四个位置即东北天、西南天、北东地、南西地位置,分别在每个位置上静态采集15分钟,将输出数据取均值并存储到标定矩阵内;步骤六:利用最小二乘法解算加速度计标定参数,利用解析法计算陀螺标定参数;1)利用最小二乘法解算加速度计标定参数:利用步骤三中十二位置的测量结果,其中
表示x轴朝天的所有位置j轴输出的平均值;
表示x轴朝地的所有位置j轴输出的平均值;
表示y轴朝天的所有位置j轴输出的平均值;
表示y轴朝地的所有位置j轴输出的平均值;
表示z轴朝天的所有位置j轴输出的平均值;
表示z轴朝地的所有位置j轴输出的平均值;B ax = ( f ‾ ax x + + f ‾ ax x - + f ‾ ax y + + f ‾ ax y - + f ‾ ax z + + f ‾ ax z - ) / 6 . . . ( 3 ) ]]>k axx = ( f ‾ ax x + - f ‾ ax x - ) / 2 g . . . ( 4 ) ]]>k axy = ( f ‾ ax y + - f ‾ ax y - ) / 2 g . . . ( 5 ) ]]>k axz = ( f ‾ ax z + - f ‾ ax z - ) / 2 g . . . ( 6 ) ]]>B ay = ( f ‾ ay x + + f ‾ ay x - + f ‾ ay y + + f ‾ ay y - + f ‾ ay z + + f ‾ ay z - ) / 6 . . . ( 7 ) ]]>k ayx = ( f ‾ ay x + - f ‾ ay x - ) / 2 g . . . ( 8 ) ]]>k ayy = ( f ‾ ay y + - f ‾ ay y - ) / 2 g . . . ( 9 ) ]]>k ayz = ( f ‾ ay z + - f ‾ ay z - ) / 2 g . . . ( 10 ) ]]>B az = ( f ‾ az x + + f ‾ az x - + f ‾ az y + + f ‾ az y - + f ‾ az z + + f ‾ az z - ) / 6 . . . ( 11 ) ]]>k azx = ( f ‾ az x + - f ‾ az x - ) / 2 g . . . ( 12 ) ]]>k azy = ( f ‾ az y + - f ‾ az y - ) / 2 g . . . ( 13 ) ]]>k azz = ( f ‾ az z + - f ‾ az z - ) / 2 g . . . ( 14 ) ]]> 2)利用解析法解算陀螺标度因数和失准角:利用步骤四中三轴正反转测量结果,其中
为绕j(j=x,y,z)以角速率±ωk为转动速率,在旋转n周时间内,i(i=x,y,z)轴分别在角速率ωk、-ωk输出的平均值之差,ω1、ω2、ω3、ω4、ω5分别为2°/s,10°/s,30°/s,60°/s,100°/s;k gx = ( ΔF gxx 1 ‾ 2 ω 1 + ΔF gxx 2 ‾ 2 ω 2 + ΔF gxx 3 ‾ 2 ω 3 + ΔF gxx 4 ‾ 2 ω 4 + ΔF gxx 5 ‾ 2 ω 5 ) / 5 . . . ( 15 ) ]]>k gy = ( ΔF gyy 1 ‾ 2 ω 1 + ΔF gyy 2 ‾ 2 ω 2 + ΔF gyy 3 ‾ 2 ω 3 + ΔF gyy 4 ‾ 2 ω 4 + ΔF gyy 5 ‾ 2 ω 5 ) / 5 . . . ( 16 ) ]]>k gz = ( ΔF gzz 1 ‾ 2 ω 1 + ΔF gzz 2 ‾ 2 ω 2 + ΔF gzz 3 ‾ 2 ω 3 + ΔF gzz 4 ‾ 2 ω 4 + ΔF gzz 5 ‾ 2 ω 5 ) / 5 . . . ( 17 ) ]]>E gxy = ( ΔF gxy 1 ‾ 2 ω 1 + ΔF gxy 2 ‾ 2 ω 2 + ΔF gxy 3 ‾ 2 ω 3 + ΔF gxy 4 ‾ 2 ω 4 + ΔF gxy 5 ‾ 2 ω 5 ) / 5 . . . ( 18 ) ]]>E gxz = ( ΔF gxz 1 ‾ 2 ω 1 + ΔF gxz 2 ‾ 2 ω 2 + ΔF gxz 3 ‾ 2 ω 3 + ΔF gxz 4 ‾ 2 ω 4 + ΔF gxz 5 ‾ 2 ω 5 ) / 5 . . . ( 19 ) ]]>E gyx = ( ΔF gyx 1 ‾ 2 ω 1 + ΔF gyx 2 ‾ 2 ω 2 + ΔF gyx 3 ‾ 2 ω 3 + ΔF gyx 4 ‾ 2 ω 4 + ΔF gyx 5 ‾ 2 ω 5 ) / 5 . . . ( 20 ) ]]>E gyz = ( ΔF gyz 1 ‾ 2 ω 1 + ΔF gyz 2 ‾ 2 ω 2 + ΔF gyz 3 ‾ 2 ω 3 + ΔF gyz 4 ‾ 2 ω 4 + ΔF gyz 5 ‾ 2 ω 5 ) / 5 . . . ( 21 ) ]]>E gzx = ( ΔF gzx 1 ‾ 2 ω 1 + ΔF gzx 2 ‾ 2 ω 2 + ΔF gzx 3 ‾ 2 ω 3 + ΔF gzx 4 ‾ 2 ω 4 + ΔF gzx 5 ‾ 2 ω 5 ) / 5 . . . ( 22 ) ]]>E gzy = ( ΔF gzy 1 ‾ 2 ω 1 + ΔF gzy ‾ 2 ω 2 + ΔF gzy 3 ‾ 2 ω 3 + ΔF gzy 4 ‾ 2 ω 4 + ΔF gzy 5 ‾ 2 ω 5 ) / 5 . . . ( 23 ) ]]> 3)利用解析法解算陀螺零偏Bgx=(f1x+f2x+f3x+f4x)/4..............................................(24)Bgy=(f1y+f2y+f3y+f4y)/4..............................................(25)Bgz=(f1z+f2z+f3z+f4z)/4..............................................(26)利用步骤五中测量结果,fij表示i位置j轴陀螺输出(i=1,2,3,4;j=x,y,z)。
下载完整专利技术内容需要扣除积分,VIP会员可以免费下载。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于北京航空航天大学,未经北京航空航天大学许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/patent/201210050032.3/,转载请声明来源钻瓜专利网。
- 上一篇:报文转发方法和设备
- 下一篇:一种膨胀型阻燃剂及其制备方法