发明名称 一种三轴正交一轴斜置构型光纤陀螺惯测装置的标定方法
摘要 本发明包括一种三轴正交一轴斜置构型光纤陀螺惯测装置的标定方法,特别用于航天器导航、制导与控制的系统标定方法,属于惯性测量技术领域,本发明的标定方法用于精确地标定出该构型光纤陀螺惯测装置零位、标度因数和安装误差,方法简单易行,能够有效地提高标定精度。本发明无须更换工装,保证基准面的一致性;该方法无需区分标度因数和安装误差,避免了计算安装误差小量产生的计算误差;同其他类型光纤陀螺惯测装置测试方法相比,该方法简单易行,提高了标定效率,节约了人力、物力。
申请公布号 CN103697918A 申请公布日期 2014.04.02
申请号 CN201310738905.4 申请日期 2013.12.26
申请人 北京航天时代光电科技有限公司 发明人 张峰;杨清生;黄磊;向政;孟祥涛;王颂邦;郑极石;何熠;马晓洁
分类号 G01C25/00(2006.01)I 主分类号 G01C25/00(2006.01)I
代理机构 中国航天科技专利中心 11009 代理人 安丽
主权项 1.一种三轴正交一轴斜置构型光纤陀螺惯测装置的标定方法,其特征在于:包括如下步骤: (1)将包含X轴、Y轴、Z轴、S轴,其中X轴、Y轴、Z轴三轴正交的光纤陀螺惯测装置装入六面体工装放置在转台上,将光纤陀螺惯测装置i轴朝天,转台逆时针旋转角速率ω<sub>i,1</sub>~ω<sub>i,m</sub>,对应i轴输入角速率为(ω<sub>i,1</sub>+ω<sub>u</sub>)~(ω<sub>i,m</sub>+ω<sub>u</sub>),输出角速率为F<sub>i,1</sub>~F<sub>i,m</sub>;转台顺时针旋转角速率为ω<sub>i,-1</sub>~ω<sub>i,-m</sub>,对应i轴输入角速率为(ω<sub>i,-1</sub>+ω<sub>u</sub>)~(ω<sub>i,-m</sub>+ω<sub>u</sub>),输出角速率为F<sub>i,-1</sub>~F<sub>i,-m</sub>,i为X、Y、Z,ω<sub>u</sub>为地速在天向方向的分量,ω<sub>u</sub>=ω<sub>ie</sub>·sin(L),L为当地的纬度,ω<sub>ie</sub>为地球自转角速度; (2)转台从静止开始,正负交替旋转,旋转整数圈,标定过程中不使用转台静止时的被测轴输出数据,分别旋转X轴、Y轴和Z轴。定义如下参数矩阵: <img file="FDA0000447303970000011.GIF" wi="486" he="313" />F<sub>x0</sub>表示X轴零偏;K<sub>xx</sub>表示X轴输出在X轴的耦合系数;K<sub>xy</sub>表示Y轴输出在X轴的耦合系数;K<sub>xz</sub>表示Z轴输出在X轴的耦合系数;F<sub>y0</sub>表示Y轴零偏;K<sub>yx</sub>表示X轴输出在Y轴的耦合系数;K<sub>yy</sub>表示Y轴输出在Y轴的耦合系数;K<sub>yz</sub>表示Z轴输出在Y轴的耦合系数;F<sub>z0</sub>表示Z轴零偏;K<sub>zx</sub>表示X轴输出在Z轴的耦合系数;K<sub>zy</sub>表示Y轴输出在Z轴的耦合系数;K<sub>zz</sub>表示Z轴输出在Z轴的耦合系数;F<sub>s0</sub>表示S轴零偏;K<sub>sx</sub>表示X轴输出在S轴的耦合系数;K<sub>sy</sub>表示Y轴输出在S轴的耦合系数;K<sub>sz</sub>表示Z轴输出在S轴的耦合系数; X轴朝天输入输出关系如下: <img file="FDA0000447303970000021.GIF" wi="1089" he="464" />其中ε<sub>x,1</sub>表示输入角速度为1°/s的随机噪声;ε<sub>x,m</sub>表示输入角速度为m°/s的随机噪声;ε<sub>x,-1</sub>表示输入角速度为-1°/s的随机噪声;ε<sub>x,-m</sub>表示输入角速度为-m°/s的随机噪声; Y轴朝天输入输出关系如下: <img file="FDA0000447303970000022.GIF" wi="1102" he="463" />其中ε<sub>y,1</sub>表示输入角速度为1°/s的随机噪声;ε<sub>y,m</sub>表示输入角速度为m°/s的随机噪声;ε<sub>y,-1</sub>表示输入角速度为-1°/s的随机噪声;ε<sub>y,-m</sub>表示输入角速度为-m°/s的随机噪声; Z轴朝天输入输出关系如下: <img file="FDA0000447303970000023.GIF" wi="1081" he="463" />其中ε<sub>z,1</sub>表示输入角速度为1°/s的随机噪声;ε<sub>z,m</sub>表示输入角速度为m°/s的随机噪声;ε<sub>z,-1</sub>表示输入角速度为-1°/s的随机噪声;ε<sub>z,-m</sub>表示输入角速度为-m°/s的随机噪声; S轴朝天输入输出关系如下: <img file="FDA0000447303970000031.GIF" wi="1255" he="988" />其中F<sub>s,x,1</sub>表示X轴朝天旋转1°/s时,S轴输出;F<sub>s,y,1</sub>表示Y轴朝天旋转1°/s时,S轴输出;F<sub>s,z,1</sub>表示Z轴朝天旋转1°/s时,S轴输出;F<sub>s,x,-1</sub>表示X轴朝天旋转-1°/s时,S轴输出;F<sub>s,y,-1</sub>表示Y轴朝天旋转-1°/s时,S轴输出;F<sub>s,z,-1</sub>表示Z轴朝天旋转-1°/s时,S轴输出;F<sub>s,x,m</sub>表示X轴朝天旋转m°/s时,S轴输出;F<sub>s,y,m</sub>表示Y轴朝天旋转m°/s时,S轴输出;F<sub>s,z,m</sub>表示Z轴朝天旋转m°/s时,S轴输出;F<sub>s,x,-m</sub>表示X轴朝天旋转-m°/s时,S轴输出;F<sub>s,y,-m</sub>表示Y轴朝天旋转-m°/s时,S轴输出;F<sub>s,z,-m</sub>表示Z轴朝天旋转-m°/s时,S轴输出;ε<sub>s,x,1</sub>表示X轴朝天旋转1°/s时,S轴输出的随机噪声;ε<sub>s,y,1</sub>表示Y轴朝天旋转1°/s时,S轴输出的随机噪声;ε<sub>s,z,1</sub>表示Z轴朝天旋转1°/s时,S轴输出的随机噪声;ε<sub>s,x,-1</sub>表示X轴朝天旋转-1°/s时,S轴输出的随机噪声;ε<sub>s,y,-1</sub>表示Y轴朝天旋转-1°/s时,S轴输出的随机噪声;ε<sub>s,z,-1</sub>表示Z轴朝天旋转-1°/s时,S轴输出的随机噪声;ε<sub>s,x,m</sub>表示X轴朝天旋转m°/s时,S轴输出的随机噪声;ε<sub>s,y,m</sub>表示Y轴朝天旋转m°/s时,S轴输出的随机噪声;ε<sub>s,z,m</sub>表示Z轴朝天旋转m°/s时,S轴输出的随机噪声;ε<sub>s,x,-m</sub>表示X轴朝天旋转-m°/s时,S轴输出的随机噪声;ε<sub>s,y,-m</sub>表示Y轴朝天旋转-m°/s时,S轴输出的随机噪声;ε<sub>s,z,-m</sub>表示Z轴朝天旋转-m°/s时,S轴输出的随机噪声; (3)对步骤(2)中得到的数据进行最小二次法求解得出X轴、Y轴、Z轴和S轴的参数,如下: <img file="FDA0000447303970000041.GIF" wi="1861" he="278" /><img file="FDA0000447303970000042.GIF" wi="1857" he="266" /><img file="FDA0000447303970000043.GIF" wi="1897" he="264" /><img file="FDA0000447303970000044.GIF" wi="2024" he="395" />上述M按如下式子进行计算: <img file="FDA0000447303970000045.GIF" wi="1854" he="336" />(4)对步骤(3)得到的结果进行算法修正:定义<img file="FDA0000447303970000046.GIF" wi="264" he="308" /><img file="FDA0000447303970000047.GIF" wi="269" he="313" /><img file="FDA0000447303970000048.GIF" wi="264" he="307" /><img file="FDA0000447303970000049.GIF" wi="263" he="308" />X轴估计误差均方差为:<img file="FDA0000447303970000051.GIF" wi="1400" he="475" />其中R<sub>x,1</sub>为X轴朝天旋转1°/s时,估计误差均方差;R<sub>x,m</sub>为X轴朝天旋转m°/s时,估计误差均方差;R<sub>x,-1</sub>为X轴朝天旋转-1°/s时,估计误差均方差;R<sub>x,-m</sub>为X轴朝天旋转-m°/s时,估计误差均方差。构造正定矩阵W<sub>x</sub>,表达式如下: <img file="FDA0000447303970000052.GIF" wi="772" he="689" />求出X轴的参数为: <img file="FDA0000447303970000054.GIF" wi="2010" he="273" />Y轴估计误差均方差为: <img file="FDA0000447303970000053.GIF" wi="1414" he="470" />其中R<sub>y,1</sub>为Y轴朝天旋转1°/s时,估计误差均方差;R<sub>y,m</sub>为Y轴朝天旋转m°/s时,估计误差均方差;R<sub>y,-1</sub>为Y轴朝天旋转-1°/s时,估计误差均方差;R<sub>y,-m</sub>为Y轴朝天旋转-m°/s时,估计误差均方差。构造正定矩阵W<sub>y</sub>,表达式如下: <img file="FDA0000447303970000061.GIF" wi="782" he="699" />求出Y轴的参数为: <img file="FDA0000447303970000062.GIF" wi="2040" he="294" />Z轴估计误差均方差为: <img file="FDA0000447303970000063.GIF" wi="1396" he="469" />其中R<sub>z,1</sub>为Z轴朝天旋转1°/s时,估计误差均方差;R<sub>z,m</sub>为Z轴朝天旋转m°/s时,估计误差均方差;R<sub>z,-1</sub>为Z轴朝天旋转-1°/s时,估计误差均方差;R<sub>z,-m</sub>为Z轴朝天旋转-m°/s时,估计误差均方差。构造正定矩阵W<sub>z</sub>,表达式如下: <img file="FDA0000447303970000064.GIF" wi="768" he="688" />求出Z轴的参数为: <img file="FDA0000447303970000071.GIF" wi="2041" he="296" />S轴估计误差均方差为: <img file="FDA0000447303970000072.GIF" wi="1473" he="993" />其中R<sub>s,x,1</sub>表示X轴朝天旋转1°/s时,S轴输出估计误差均方差;R<sub>s,y,1</sub>表示Y轴朝天旋转1°/s时,S轴输出估计误差均方差;R<sub>s,z,1</sub>表示Z轴朝天旋转1°/s时,S轴输出估计误差均方差;R<sub>s,x,-1</sub>表示X轴朝天旋转-1°/s时,S轴输出估计误差均方差;R<sub>s,y,-1</sub>表示Y轴朝天旋转-1°/s时,S轴输出估计误差均方差;R<sub>s,z,-1</sub>表示Z轴朝天旋转-1°/s时,S轴输出估计误差均方差;R<sub>s,x,m</sub>表示X轴朝天旋转m°/s时,S轴输出估计误差均方差;R<sub>s,y,m</sub>表示Y轴朝天旋转m°/s时,S轴输出估计误差均方差;R<sub>s,z,m</sub>表示Z轴朝天旋转m°/s时,S轴输出估计误差均方差;R<sub>s,x,-m</sub>表示X轴朝天旋转-m°/s时,S轴输出估计误差均方差;R<sub>s,y,-m</sub>表示Y轴朝天旋转-m°/s时,S轴输出估计误差均方差;R<sub>s,z,-m</sub>表示Z轴朝天旋转-m°/s时,S轴输出估计误差均方差;构造正定矩阵W<sub>s</sub>,表达式如下: <img file="FDA0000447303970000081.GIF" wi="1995" he="1763" />求出S轴的参数为: <img file="FDA0000447303970000082.GIF" wi="2030" he="293" />(5)通过上述方法求出X轴、Y轴、Z轴、S轴参数,如下: X轴参数:F'<sub>x0</sub>、K'<sub>xx</sub>、K'<sub>xy</sub>、K'<sub>xz</sub>Y轴参数:F'<sub>y0</sub>、K'<sub>yx</sub>、K'<sub>yy</sub>、K'<sub>yz</sub>Z轴参数:F'<sub>z0</sub>、K'<sub>zx</sub>、K'<sub>zy</sub>、K'<sub>zz</sub>S轴参数:F'<sub>s0</sub>、K'<sub>sx</sub>、K'<sub>sy</sub>、K'<sub>sz。</sub>
地址 100094 北京市海淀区丰滢东路1号