发明名称 光纤陀螺捷联惯性导航系统的单轴转台标定方法
摘要 本发明的目的在于提供光纤陀螺捷联惯性导航系统的单轴转台标定方法。将光纤陀螺捷联惯性导航系统放置于单轴转台上,光纤陀螺捷联惯性导航系统通电进行预热,采集光纤陀螺输出的角速度和和石英挠性加速度计输出的比力,之后将控制单轴转台绕其转动轴逆时针旋转90°三次,并采集每次光纤陀螺输出的角速度和和石英挠性加速度计输出的比力,进而得到惯性器件坐标系x、y、z轴光纤陀螺的漂移和以及惯性器件坐标系x、y、z轴石英挠性加速度计的零位偏值。利用单轴转台旋转不同的角位置,便可测量出光纤陀螺的漂移和石英挠性加速度计的零位偏值的方法,并且单轴转台标定成本低,步骤简单,标定时单轴转台放置于地面即可,无需试验室环境。
申请公布号 CN102003968A 申请公布日期 2011.04.06
申请号 CN201010270939.1 申请日期 2010.09.03
申请人 哈尔滨工程大学 发明人 奔粤阳;吴晓;李倩;高伟;付建楠;王秋滢;盛宏媛;张义;车延庭;南兆君
分类号 G01C25/00(2006.01)I;G01C21/18(2006.01)I 主分类号 G01C25/00(2006.01)I
代理机构 代理人
主权项 1.光纤陀螺捷联惯性导航系统的单轴转台标定方法,其特征是:(1)将光纤陀螺捷联惯性导航系统放置于单轴转台上,光纤陀螺捷联惯性导航系统通电进行预热,然后采集陀螺仪和加速度计输出的数据;(2)记初始时刻光纤陀螺捷联惯性导航系统所在位置为a位置,在a位置采集300秒内光纤陀螺输出的角速度ω<sup>a</sup>(1),ω<sup>a</sup>(2),...ω<sup>a</sup>(N)和石英挠性加速度计输出的比力f<sup>a</sup>(1),f<sup>a</sup>(2),...f<sup>a</sup>(N),其中<img file="FSA00000255263400011.GIF" wi="192" he="108" />h为光纤陀螺捷联惯性导航系统的采样周期,上角标a表示数据采集时光纤陀螺捷联惯性导航系统处在a位置;(3)由步骤(2)测量结果,得出a位置上光纤陀螺输出的角速度平均值<maths num="0001"><![CDATA[<math><mrow><mover><msup><mi>&omega;</mi><mi>a</mi></msup><mo>&OverBar;</mo></mover><mo>=</mo><mfrac><mrow><msup><mi>&omega;</mi><mi>a</mi></msup><mrow><mo>(</mo><mn>1</mn><mo>)</mo></mrow><mo>+</mo><msup><mi>&omega;</mi><mi>a</mi></msup><mrow><mo>(</mo><mn>2</mn><mo>)</mo></mrow><mo>+</mo><mo>.</mo><mo>.</mo><mo>.</mo><mo>.</mo><mo>.</mo><mo>.</mo><msup><mrow><mo>+</mo><mi>&omega;</mi></mrow><mi>a</mi></msup><mrow><mo>(</mo><mi>N</mi><mo>-</mo><mn>1</mn><mo>)</mo></mrow><mo>+</mo><msup><mi>&omega;</mi><mi>a</mi></msup><mrow><mo>(</mo><mi>N</mi><mo>)</mo></mrow></mrow><mi>N</mi></mfrac></mrow></math>]]></maths>和石英挠性加速度计输出的比力平均值<maths num="0002"><![CDATA[<math><mrow><mover><msup><mi>f</mi><mi>a</mi></msup><mo>&OverBar;</mo></mover><mo>=</mo><mfrac><mrow><msup><mi>f</mi><mi>a</mi></msup><mrow><mo>(</mo><mn>1</mn><mo>)</mo></mrow><mo>+</mo><msup><mi>f</mi><mi>a</mi></msup><mrow><mo>(</mo><mn>2</mn><mo>)</mo></mrow><mo>+</mo><mo>.</mo><mo>.</mo><mo>.</mo><mo>.</mo><mo>.</mo><mo>.</mo><mo>+</mo><msup><mi>f</mi><mi>a</mi></msup><mrow><mo>(</mo><mi>N</mi><mo>-</mo><mn>1</mn><mo>)</mo></mrow><mo>+</mo><msup><mi>f</mi><mi>a</mi></msup><mrow><mo>(</mo><mi>N</mi><mo>)</mo></mrow></mrow><mi>N</mi></mfrac><mo>,</mo></mrow></math>]]></maths><img file="FSA00000255263400014.GIF" wi="57" he="57" />的惯性器件坐标系投影形式为<maths num="0003"><![CDATA[<math><mrow><mover><msup><mi>&omega;</mi><mi>a</mi></msup><mo>&OverBar;</mo></mover><mo>=</mo><mfenced open='[' close=']'><mtable><mtr><mtd><mover><msubsup><mi>&omega;</mi><mi>x</mi><mi>a</mi></msubsup><mo>&OverBar;</mo></mover></mtd></mtr><mtr><mtd><mover><msubsup><mi>&omega;</mi><mi>y</mi><mi>a</mi></msubsup><mo>&OverBar;</mo></mover></mtd></mtr><mtr><mtd><mover><msubsup><mi>&omega;</mi><mi>z</mi><mi>a</mi></msubsup><mo>&OverBar;</mo></mover></mtd></mtr></mtable></mfenced><mo>,</mo></mrow></math>]]></maths><img file="FSA00000255263400016.GIF" wi="57" he="67" />的惯性器件坐标系投影形式为<maths num="0004"><![CDATA[<math><mrow><mover><msup><mi>f</mi><mi>a</mi></msup><mo>&OverBar;</mo></mover><mo>=</mo><mfenced open='[' close=']'><mtable><mtr><mtd><mover><msubsup><mi>f</mi><mi>x</mi><mi>a</mi></msubsup><mo>&OverBar;</mo></mover></mtd></mtr><mtr><mtd><mover><msubsup><mi>f</mi><mi>y</mi><mi>a</mi></msubsup><mo>&OverBar;</mo></mover></mtd></mtr><mtr><mtd><mover><msubsup><mi>f</mi><mi>z</mi><mi>a</mi></msubsup><mo>&OverBar;</mo></mover></mtd></mtr></mtable></mfenced><mo>,</mo></mrow></math>]]></maths>下角标x表示惯性器件坐标系x轴,y表示惯性器件坐标系y轴,z表示惯性器件坐标系z轴;(4)控制单轴转台绕其转动轴逆时针旋转90°,记转动后光纤陀螺捷联惯性导航系统所在位置为b位置,在b位置采集300秒内光纤陀螺输出的角速度ω<sup>b</sup>(1),ω<sup>b</sup>(2),...ω<sup>b</sup>(N)和石英挠性加速度计输出的比力f<sup>b</sup>(1),f<sup>b</sup>(2),...f<sup>b</sup>(N),上角标b表示数据采集时,光纤陀螺捷联惯性导航系统处在b位置;(5)由步骤(4)测量结果,得出b位置上光纤陀螺的输出的角速度平均值<maths num="0005"><![CDATA[<math><mrow><mover><msup><mi>&omega;</mi><mi>b</mi></msup><mo>&OverBar;</mo></mover><mo>=</mo><mfrac><mrow><msup><mi>&omega;</mi><mi>b</mi></msup><mrow><mo>(</mo><mn>1</mn><mo>)</mo></mrow><mo>+</mo><msup><mi>&omega;</mi><mi>b</mi></msup><mrow><mo>(</mo><mn>2</mn><mo>)</mo></mrow><mo>+</mo><mo>.</mo><mo>.</mo><mo>.</mo><mo>.</mo><mo>.</mo><mo>.</mo><msup><mrow><mo>+</mo><mi>&omega;</mi></mrow><mi>b</mi></msup><mrow><mo>(</mo><mi>N</mi><mo>-</mo><mn>1</mn><mo>)</mo></mrow><mo>+</mo><msup><mi>&omega;</mi><mi>b</mi></msup><mrow><mo>(</mo><mi>N</mi><mo>)</mo></mrow></mrow><mi>N</mi></mfrac></mrow></math>]]></maths>和石英挠性加速度计输出的比力平均值<maths num="0006"><![CDATA[<math><mrow><mover><msup><mi>f</mi><mi>b</mi></msup><mo>&OverBar;</mo></mover><mo>=</mo><mfrac><mrow><msup><mi>f</mi><mi>b</mi></msup><mrow><mo>(</mo><mn>1</mn><mo>)</mo></mrow><mo>+</mo><msup><mi>f</mi><mi>b</mi></msup><mrow><mo>(</mo><mn>2</mn><mo>)</mo></mrow><mo>+</mo><mo>.</mo><mo>.</mo><mo>.</mo><mo>.</mo><mo>.</mo><mo>.</mo><mo>+</mo><msup><mi>f</mi><mi>b</mi></msup><mrow><mo>(</mo><mi>N</mi><mo>-</mo><mn>1</mn><mo>)</mo></mrow><mo>+</mo><msup><mi>f</mi><mi>b</mi></msup><mrow><mo>(</mo><mi>N</mi><mo>)</mo></mrow></mrow><mi>N</mi></mfrac><mo>,</mo></mrow></math>]]></maths><img file="FSA00000255263400023.GIF" wi="57" he="56" />的惯性器件坐标系投影形式为<maths num="0007"><![CDATA[<math><mrow><mover><msup><mi>&omega;</mi><mi>b</mi></msup><mo>&OverBar;</mo></mover><mo>=</mo><mfenced open='[' close=']'><mtable><mtr><mtd><mover><msubsup><mi>&omega;</mi><mi>x</mi><mi>b</mi></msubsup><mo>&OverBar;</mo></mover></mtd></mtr><mtr><mtd><mover><msubsup><mi>&omega;</mi><mi>y</mi><mi>b</mi></msubsup><mo>&OverBar;</mo></mover></mtd></mtr><mtr><mtd><mover><msubsup><mi>&omega;</mi><mi>z</mi><mi>b</mi></msubsup><mo>&OverBar;</mo></mover></mtd></mtr></mtable></mfenced><mo>,</mo></mrow></math>]]></maths><img file="FSA00000255263400025.GIF" wi="58" he="67" />的惯性器件坐标系投影形式为<maths num="0008"><![CDATA[<math><mrow><mover><msup><mi>f</mi><mi>b</mi></msup><mo>&OverBar;</mo></mover><mo>=</mo><mfenced open='[' close=']'><mtable><mtr><mtd><mover><msubsup><mi>f</mi><mi>x</mi><mi>b</mi></msubsup><mo>&OverBar;</mo></mover></mtd></mtr><mtr><mtd><mover><msubsup><mi>f</mi><mi>y</mi><mi>b</mi></msubsup><mo>&OverBar;</mo></mover></mtd></mtr><mtr><mtd><mover><msubsup><mi>f</mi><mi>z</mi><mi>b</mi></msubsup><mo>&OverBar;</mo></mover></mtd></mtr></mtable></mfenced><mo>;</mo></mrow></math>]]></maths>(6)控制单轴转台绕其转动轴逆时针旋转90°,记转动后光纤陀螺捷联惯性导航系统所在位置为c位置,在c位置采集300秒内光纤陀螺输出的角速度ω<sup>c</sup>(1),ω<sup>c</sup>(2),...ω<sup>c</sup>(N)和石英挠性加速度计输出的比力f<sup>c</sup>(1),f<sup>c</sup>(2),...f<sup>c</sup>(N),上角标c表示数据采集时光纤陀螺捷联惯性导航系统处在c位置;(7)由步骤(6)测量结果,得出c位置上光纤陀螺的输出的角速度平均值<maths num="0009"><![CDATA[<math><mrow><mover><msup><mi>&omega;</mi><mi>c</mi></msup><mo>&OverBar;</mo></mover><mo>=</mo><mfrac><mrow><msup><mi>&omega;</mi><mi>c</mi></msup><mrow><mo>(</mo><mn>1</mn><mo>)</mo></mrow><mo>+</mo><msup><mi>&omega;</mi><mi>c</mi></msup><mrow><mo>(</mo><mn>2</mn><mo>)</mo></mrow><mo>+</mo><mo>.</mo><mo>.</mo><mo>.</mo><mo>.</mo><mo>.</mo><mo>.</mo><msup><mrow><mo>+</mo><mi>&omega;</mi></mrow><mi>c</mi></msup><mrow><mo>(</mo><mi>N</mi><mo>-</mo><mn>1</mn><mo>)</mo></mrow><mo>+</mo><msup><mi>&omega;</mi><mi>c</mi></msup><mrow><mo>(</mo><mi>N</mi><mo>)</mo></mrow></mrow><mi>N</mi></mfrac></mrow></math>]]></maths>和石英挠性加速度计输出的比力平均值<maths num="0010"><![CDATA[<math><mrow><mover><msup><mi>f</mi><mi>c</mi></msup><mo>&OverBar;</mo></mover><mo>=</mo><mfrac><mrow><msup><mi>f</mi><mi>c</mi></msup><mrow><mo>(</mo><mn>1</mn><mo>)</mo></mrow><mo>+</mo><msup><mi>f</mi><mi>c</mi></msup><mrow><mo>(</mo><mn>2</mn><mo>)</mo></mrow><mo>+</mo><mo>.</mo><mo>.</mo><mo>.</mo><mo>.</mo><mo>.</mo><mo>.</mo><mo>+</mo><msup><mi>f</mi><mi>c</mi></msup><mrow><mo>(</mo><mi>N</mi><mo>-</mo><mn>1</mn><mo>)</mo></mrow><mo>+</mo><msup><mi>f</mi><mi>c</mi></msup><mrow><mo>(</mo><mi>N</mi><mo>)</mo></mrow></mrow><mi>N</mi></mfrac><mo>,</mo></mrow></math>]]></maths><img file="FSA00000255263400032.GIF" wi="55" he="57" />的惯性器件坐标系投影形式为<maths num="0011"><![CDATA[<math><mrow><mover><msup><mi>&omega;</mi><mi>c</mi></msup><mo>&OverBar;</mo></mover><mo>=</mo><mfenced open='[' close=']'><mtable><mtr><mtd><mover><msubsup><mi>&omega;</mi><mi>x</mi><mi>c</mi></msubsup><mo>&OverBar;</mo></mover></mtd></mtr><mtr><mtd><mover><msubsup><mi>&omega;</mi><mi>y</mi><mi>c</mi></msubsup><mo>&OverBar;</mo></mover></mtd></mtr><mtr><mtd><mover><msubsup><mi>&omega;</mi><mi>z</mi><mi>c</mi></msubsup><mo>&OverBar;</mo></mover></mtd></mtr></mtable></mfenced><mo>,</mo></mrow></math>]]></maths><img file="FSA00000255263400034.GIF" wi="55" he="68" />的惯性器件坐标系投影形式为<maths num="0012"><![CDATA[<math><mrow><mover><msup><mi>f</mi><mi>c</mi></msup><mo>&OverBar;</mo></mover><mo>=</mo><mfenced open='[' close=']'><mtable><mtr><mtd><mover><msubsup><mi>f</mi><mi>x</mi><mi>c</mi></msubsup><mo>&OverBar;</mo></mover></mtd></mtr><mtr><mtd><mover><msubsup><mi>f</mi><mi>y</mi><mi>c</mi></msubsup><mo>&OverBar;</mo></mover></mtd></mtr><mtr><mtd><mover><msubsup><mi>f</mi><mi>z</mi><mi>c</mi></msubsup><mo>&OverBar;</mo></mover></mtd></mtr></mtable></mfenced><mo>;</mo></mrow></math>]]></maths>(8)控制单轴转台绕其转动轴逆时针旋转90°,记转动后光纤陀螺捷联惯性导航系统所在位置为d位置,在d位置采集300秒内光纤陀螺输出的角速度ω<sup>d</sup>(1),ω<sup>d</sup>(2),...ω<sup>d</sup>(N),和石英挠性加速度计输出的比力f<sup>d</sup>(1),f<sup>d</sup>(2),...f<sup>d</sup>(N),上角标d表示数据采集时光纤陀螺捷联惯性导航系统处在d位置;(9)由步骤(8)测量结果,得出c位置上光纤陀螺的输出的角速度平均值<maths num="0013"><![CDATA[<math><mrow><mover><msup><mi>&omega;</mi><mi>d</mi></msup><mo>&OverBar;</mo></mover><mo>=</mo><mfrac><mrow><msup><mi>&omega;</mi><mi>d</mi></msup><mrow><mo>(</mo><mn>1</mn><mo>)</mo></mrow><mo>+</mo><msup><mi>&omega;</mi><mi>d</mi></msup><mrow><mo>(</mo><mn>2</mn><mo>)</mo></mrow><mo>+</mo><mo>.</mo><mo>.</mo><mo>.</mo><mo>.</mo><mo>.</mo><mo>.</mo><mo>+</mo><msup><mi>&omega;</mi><mi>d</mi></msup><mrow><mo>(</mo><mi>N</mi><mo>-</mo><mn>1</mn><mo>)</mo></mrow><mo>+</mo><msup><mi>&omega;</mi><mi>d</mi></msup><mrow><mo>(</mo><mi>N</mi><mo>)</mo></mrow></mrow><mi>N</mi></mfrac></mrow></math>]]></maths>和石英挠性加速度计输出的比力平均值<maths num="0014"><![CDATA[<math><mrow><mover><msup><mi>f</mi><mi>d</mi></msup><mo>&OverBar;</mo></mover><mo>=</mo><mfrac><mrow><msup><mi>f</mi><mi>d</mi></msup><mrow><mo>(</mo><mn>1</mn><mo>)</mo></mrow><mo>+</mo><msup><mi>f</mi><mi>d</mi></msup><mrow><mo>(</mo><mn>2</mn><mo>)</mo></mrow><mo>+</mo><mo>.</mo><mo>.</mo><mo>.</mo><mo>.</mo><mo>.</mo><mo>.</mo><mo>+</mo><msup><mi>f</mi><mi>d</mi></msup><mrow><mo>(</mo><mi>N</mi><mo>-</mo><mn>1</mn><mo>)</mo></mrow><mo>+</mo><msup><mi>f</mi><mi>d</mi></msup><mrow><mo>(</mo><mi>N</mi><mo>)</mo></mrow></mrow><mi>N</mi></mfrac><mo>,</mo></mrow></math>]]></maths><img file="FSA00000255263400038.GIF" wi="58" he="57" />的惯性器件坐标系投影形式为<maths num="0015"><![CDATA[<math><mrow><mover><msup><mi>&omega;</mi><mi>d</mi></msup><mo>&OverBar;</mo></mover><mo>=</mo><mfenced open='[' close=']'><mtable><mtr><mtd><mover><msubsup><mi>&omega;</mi><mi>x</mi><mi>d</mi></msubsup><mo>&OverBar;</mo></mover></mtd></mtr><mtr><mtd><mover><msubsup><mi>&omega;</mi><mi>y</mi><mi>d</mi></msubsup><mo>&OverBar;</mo></mover></mtd></mtr><mtr><mtd><mover><msubsup><mi>&omega;</mi><mi>z</mi><mi>d</mi></msubsup><mo>&OverBar;</mo></mover></mtd></mtr></mtable></mfenced><mo>,</mo></mrow></math>]]></maths><img file="FSA000002552634000310.GIF" wi="60" he="67" />的惯性器件坐标系投影形式为<maths num="0016"><![CDATA[<math><mrow><mover><msup><mi>f</mi><mi>d</mi></msup><mo>&OverBar;</mo></mover><mo>=</mo><mfenced open='[' close=']'><mtable><mtr><mtd><mover><msubsup><mi>f</mi><mi>x</mi><mi>d</mi></msubsup><mo>&OverBar;</mo></mover></mtd></mtr><mtr><mtd><mover><msubsup><mi>f</mi><mi>y</mi><mi>d</mi></msubsup><mo>&OverBar;</mo></mover></mtd></mtr><mtr><mtd><mover><msubsup><mi>f</mi><mi>z</mi><mi>d</mi></msubsup><mo>&OverBar;</mo></mover></mtd></mtr></mtable></mfenced><mo>;</mo></mrow></math>]]></maths>(10)由步骤(3)、步骤(5)、步骤(7)、步骤(9)测量得到惯性器件坐标系x轴光纤陀螺的漂移<maths num="0017"><![CDATA[<math><mrow><msub><mi>&epsiv;</mi><mi>x</mi></msub><mo>=</mo><mfrac><mrow><mover><msubsup><mi>&omega;</mi><mi>x</mi><mi>a</mi></msubsup><mo>&OverBar;</mo></mover><mo>+</mo><mover><msubsup><mi>&omega;</mi><mi>x</mi><mi>b</mi></msubsup><mo>&OverBar;</mo></mover><mo>+</mo><mover><msubsup><mi>&omega;</mi><mi>x</mi><mi>c</mi></msubsup><mo>&OverBar;</mo></mover><mo>+</mo><mover><msubsup><mi>&omega;</mi><mi>x</mi><mi>d</mi></msubsup><mo>&OverBar;</mo></mover></mrow><mn>4</mn></mfrac><mo>,</mo></mrow></math>]]></maths>惯性器件坐标系y轴光纤陀螺的漂移<maths num="0018"><![CDATA[<math><mrow><msub><mi>&epsiv;</mi><mi>y</mi></msub><mo>=</mo><mfrac><mrow><mover><msubsup><mi>&omega;</mi><mi>y</mi><mi>a</mi></msubsup><mo>&OverBar;</mo></mover><mo>+</mo><mover><msubsup><mi>&omega;</mi><mi>y</mi><mi>b</mi></msubsup><mo>&OverBar;</mo></mover><mo>+</mo><mover><msubsup><mi>&omega;</mi><mi>y</mi><mi>c</mi></msubsup><mo>&OverBar;</mo></mover><mo>+</mo><mover><msubsup><mi>&omega;</mi><mi>y</mi><mi>d</mi></msubsup><mo>&OverBar;</mo></mover></mrow><mn>4</mn></mfrac><mo>,</mo></mrow></math>]]></maths>以及惯性器件坐标系x轴石英挠性加速度计的零位偏值<maths num="0019"><![CDATA[<math><mrow><msub><mo>&dtri;</mo><mi>x</mi></msub><mo>=</mo><mfrac><mrow><mover><msubsup><mi>f</mi><mi>x</mi><mi>a</mi></msubsup><mo>&OverBar;</mo></mover><mo>+</mo><mover><msubsup><mi>f</mi><mi>x</mi><mi>b</mi></msubsup><mo>&OverBar;</mo></mover><mo>+</mo><mover><msubsup><mi>f</mi><mi>x</mi><mi>c</mi></msubsup><mo>&OverBar;</mo></mover><mo>+</mo><mover><msubsup><mi>f</mi><mi>x</mi><mi>d</mi></msubsup><mo>&OverBar;</mo></mover></mrow><mn>4</mn></mfrac><mo>,</mo></mrow></math>]]></maths>惯性器件坐标系y轴石英挠性加速度计的零位偏值<maths num="0020"><![CDATA[<math><mrow><msub><mo>&dtri;</mo><mi>y</mi></msub><mo>=</mo><mfrac><mrow><mover><msubsup><mi>f</mi><mi>y</mi><mi>a</mi></msubsup><mo>&OverBar;</mo></mover><mo>+</mo><mover><msubsup><mi>f</mi><mi>y</mi><mi>b</mi></msubsup><mo>&OverBar;</mo></mover><mo>+</mo><mover><msubsup><mi>f</mi><mi>y</mi><mi>c</mi></msubsup><mo>&OverBar;</mo></mover><mo>+</mo><mover><msubsup><mi>f</mi><mi>y</mi><mi>d</mi></msubsup><mo>&OverBar;</mo></mover></mrow><mn>4</mn></mfrac><mo>,</mo></mrow></math>]]></maths>(11)由步骤(3)、步骤(5)、步骤(7)、步骤(9)和步骤(10)得到以下参量:在位置a时,光纤陀螺捷联惯性导航系统的纵摇角θ<maths num="0021"><![CDATA[<math><mrow><mi>&theta;</mi><mo>=</mo><mfrac><mrow><mi>arcsin</mi><mo>[</mo><mfrac><mrow><mo>(</mo><mover><msubsup><mi>f</mi><mi>y</mi><mi>c</mi></msubsup><mo>&OverBar;</mo></mover><mo>-</mo><mover><msubsup><mi>f</mi><mi>y</mi><mi>a</mi></msubsup><mo>&OverBar;</mo></mover><mo>)</mo></mrow><mrow><mn>2</mn><mi>g</mi></mrow></mfrac><mo>]</mo><mo>+</mo><mi>arcsin</mi><mo>[</mo><mfrac><mrow><mo>(</mo><mover><msubsup><mi>f</mi><mi>x</mi><mi>b</mi></msubsup><mo>&OverBar;</mo></mover><mo>-</mo><mover><msubsup><mi>f</mi><mi>x</mi><mi>d</mi></msubsup><mo>&OverBar;</mo></mover><mo>)</mo></mrow><mrow><mn>2</mn><mi>g</mi></mrow></mfrac><mo>]</mo></mrow><mn>2</mn></mfrac></mrow></math>]]></maths>其中g为光纤陀螺捷联惯性导航系统所在位置的重力值,进一步得到在位置a时,光纤陀螺捷联惯性导航系统的横摇角γ<maths num="0022"><![CDATA[<math><mrow><mi>&gamma;</mi><mo>=</mo><mfrac><mrow><mi>arcsin</mi><mo>[</mo><mfrac><mrow><mo>(</mo><mover><msubsup><mi>f</mi><mi>x</mi><mi>a</mi></msubsup><mo>&OverBar;</mo></mover><mo>-</mo><msub><mo>&dtri;</mo><mi>x</mi></msub><mo>)</mo></mrow><mrow><mi>g</mi><mi>cos</mi><mrow><mo>(</mo><mi>&theta;</mi><mo>)</mo></mrow></mrow></mfrac><mo>]</mo><mo>+</mo><mi>arcsin</mi><mo>[</mo><mfrac><mrow><mo>(</mo><mover><msubsup><mi>f</mi><mi>y</mi><mi>b</mi></msubsup><mo>&OverBar;</mo></mover><mo>-</mo><msub><mo>&dtri;</mo><mi>y</mi></msub><mo>)</mo></mrow><mrow><mi>g</mi><mi>cos</mi><mrow><mo>(</mo><mi>&theta;</mi><mo>)</mo></mrow></mrow></mfrac><mo>]</mo></mrow><mn>2</mn></mfrac></mrow></math>]]></maths>进一步得到在位置a时,光纤陀螺捷联惯性导航系统的航向角φ<maths num="0023"><![CDATA[<math><mrow><mi>&phi;</mi><mo>=</mo><mfrac><mrow><mi>arccos</mi><mo>[</mo><mfrac><mrow><mo>(</mo><mover><msubsup><mi>&omega;</mi><mi>y</mi><mi>a</mi></msubsup><mo>&OverBar;</mo></mover><mo>-</mo><msub><mi>&epsiv;</mi><mi>y</mi></msub><mo>)</mo></mrow><mrow><mi>&Omega;</mi><mi>cos</mi><mi>L</mi><mi>cos</mi><mi>&theta;</mi></mrow></mfrac><mo>-</mo><mi>tan</mi><mi>L</mi><mi>tan</mi><mi>&theta;</mi><mo>]</mo><mo>+</mo><mi>arccos</mi><mo>[</mo><mfrac><mrow><mo>(</mo><mover><msubsup><mi>&omega;</mi><mi>x</mi><mi>b</mi></msubsup><mo>&OverBar;</mo></mover><mo>-</mo><msub><mi>&epsiv;</mi><mi>x</mi></msub><mo>)</mo></mrow><mrow><mi>&Omega;</mi><mi>cos</mi><mi>L</mi><mi>cos</mi><mi>&theta;</mi></mrow></mfrac><mo>-</mo><mi>tan</mi><mi>L</mi><mi>tan</mi><mi>&theta;</mi><mo>]</mo></mrow><mn>2</mn></mfrac></mrow></math>]]></maths>其中L为光纤陀螺捷联惯性导航系统所在位置的纬度值,Ω为地球自转角速度;(12)由步骤(3)、步骤(5)、步骤(7)、步骤(9)、步骤(10)和步骤(11)测量得到惯性器件坐标系z轴光纤陀螺的漂移<maths num="0024"><![CDATA[<math><mrow><msub><mi>&epsiv;</mi><mi>z</mi></msub><mo>=</mo><mfrac><mrow><mover><msubsup><mi>&omega;</mi><mi>z</mi><mi>a</mi></msubsup><mo>&OverBar;</mo></mover><mo>+</mo><mover><msubsup><mi>&omega;</mi><mi>z</mi><mi>b</mi></msubsup><mo>&OverBar;</mo></mover><mo>+</mo><mover><msubsup><mi>&omega;</mi><mi>z</mi><mi>c</mi></msubsup><mo>&OverBar;</mo></mover><mo>+</mo><mover><msubsup><mi>&omega;</mi><mi>z</mi><mi>d</mi></msubsup><mo>&OverBar;</mo></mover></mrow><mn>4</mn></mfrac><mo>-</mo><mi>&Omega;</mi><mo>[</mo><mi>cos</mi><mi>L</mi><mrow><mo>(</mo><mi>sin</mi><mi></mi><mi>&gamma;</mi><mi>sin</mi><mi>&phi;</mi><mo>-</mo><mi>cos</mi><mi></mi><mi>&gamma;</mi><mi>sin</mi><mi></mi><mi>&theta;</mi><mi>cos</mi><mi>&phi;</mi><mo>)</mo></mrow><mo>+</mo><mi>sin</mi><mi>L</mi><mi>cos</mi><mi></mi><mi>&gamma;</mi><mi>cos</mi><mi>&theta;</mi><mo>]</mo></mrow></math>]]></maths>惯性器件坐标系z轴石英挠性加速度计的零位偏值<maths num="0025"><![CDATA[<math><mrow><msub><mo>&dtri;</mo><mi>z</mi></msub><mo>=</mo><mfrac><mrow><mover><msubsup><mi>f</mi><mi>z</mi><mi>a</mi></msubsup><mo>&OverBar;</mo></mover><mo>+</mo><mover><msubsup><mi>f</mi><mi>z</mi><mi>b</mi></msubsup><mo>&OverBar;</mo></mover><mo>+</mo><mover><msubsup><mi>f</mi><mi>z</mi><mi>c</mi></msubsup><mo>&OverBar;</mo></mover><mo>+</mo><mover><msubsup><mi>f</mi><mi>z</mi><mi>d</mi></msubsup><mo>&OverBar;</mo></mover></mrow><mn>4</mn></mfrac><mo>+</mo><mi>g</mi><mi>cos</mi><mi></mi><mi>&gamma;</mi><mi>cos</mi><mi>&theta;</mi><mo>.</mo></mrow></math>]]></maths>
地址 150001 黑龙江省哈尔滨市南岗区南通大街145号哈尔滨工程大学科技处知识产权办公室