发明名称 一种捷联惯导系统零位标定的方法
摘要 一种捷联惯导系统零位标定的方法,它涉及捷联惯导系统零位标定的方法。本发明要解决现有的零位标定方法中因被测惯性元器件的安装存在非正交误差而影响零位误差求值精度的问题。本发明方法是将惯性装置安装到三轴转台上,使转台旋转到四个指定位置,将四个不同位置的惯性元器件上由于安装误差导致感所受到的附加误差分量累加消除,从而求得惯性元器件的零位误差。本发明提出一种新的零位标定测量方法,可以有效的补偿掉安装误差所带来的影响,从而可以得到更加精确的零偏,提高系统精度。本发明方法可应用于现代武器装备的导航系统的零位标定。
申请公布号 CN103234560B 申请公布日期 2015.09.09
申请号 CN201310184385.7 申请日期 2013.05.17
申请人 哈尔滨工程大学 发明人 周广涛;时贵敏;李昕光;张勇刚;于强;郭善强
分类号 G01C25/00(2006.01)I 主分类号 G01C25/00(2006.01)I
代理机构 哈尔滨市松花江专利商标事务所 23109 代理人 杨立超
主权项 一种捷联惯导系统零位标定的方法,其特征在于一种捷联惯导系统零位标定的方法,按以下步骤进行:一、捷联系统安装在转台的基座上,其惯导系统X、Y、Z轴陀螺的主轴分别与转台的X、Y、Z轴平行;二、启动捷联惯导系统并进行充分预热;三、操作三轴转台使光纤陀螺三轴定位于北偏东45°、西偏北45°、天向位置,采集N组光纤陀螺输出数据,在此位置时捷联惯导系统任一时刻的输入角速率及输入加速度分别为:<img file="FDA0000722353280000011.GIF" wi="600" he="275" /><maths num="0001" id="cmaths0001"><math><![CDATA[<mrow><mfenced open='[' close=']'><mtable><mtr><mtd><msub><mi>A</mi><mrow><mi>x</mi><mn>1</mn></mrow></msub></mtd></mtr><mtr><mtd><msub><mi>A</mi><mrow><mi>y</mi><mn>1</mn></mrow></msub></mtd></mtr><mtr><mtd><msub><mi>A</mi><mrow><mi>z</mi><mn>1</mn></mrow></msub></mtd></mtr></mtable></mfenced><mtext>=</mtext><mfenced open='[' close=']'><mtable><mtr><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mo>-</mo><mi>g</mi></mtd></mtr></mtable></mfenced><mo>;</mo></mrow>]]></math><img file="FDA0000722353280000012.GIF" wi="350" he="272" /></maths>式中,α为转台与北向的夹角,<img file="FDA0000722353280000013.GIF" wi="43" he="47" />为测试当地的纬度;四、操作三轴转台使光纤陀螺三轴定位于北偏东45°、东偏南45°、地向位置,采集N组光纤陀螺输出数据,在此位置时捷联惯导系统任一时刻的输入角速率及输入加速度分别为:<img file="FDA0000722353280000014.GIF" wi="604" he="275" /><maths num="0002" id="cmaths0002"><math><![CDATA[<mrow><mfenced open='[' close=']'><mtable><mtr><mtd><msub><mi>A</mi><mrow><mi>x</mi><mn>2</mn></mrow></msub></mtd></mtr><mtr><mtd><mtext></mtext><msub><mi>A</mi><mrow><mi>y</mi><mn>2</mn></mrow></msub></mtd></mtr><mtr><mtd><msub><mi>A</mi><mrow><mi>z</mi><mn>2</mn></mrow></msub></mtd></mtr></mtable></mfenced><mtext>=</mtext><mfenced open='[' close=']'><mtable><mtr><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mi>g</mi></mtd></mtr></mtable></mfenced><mo>;</mo></mrow>]]></math><img file="FDA0000722353280000015.GIF" wi="321" he="274" /></maths>五、操作三轴转台使光纤陀螺三轴定位于南偏西45°、西偏北45度、地向位置,采集N组光纤陀螺输出数据,在此位置时捷联惯导系统任一时刻的输入角速率及输入加速度分别为:<img file="FDA0000722353280000016.GIF" wi="638" he="268" /><maths num="0003" id="cmaths0003"><math><![CDATA[<mrow><mfenced open='[' close=']'><mtable><mtr><mtd><msub><mi>A</mi><mrow><mi>x</mi><mn>3</mn></mrow></msub></mtd></mtr><mtr><mtd><msub><mi>A</mi><mrow><mi>y</mi><mn>3</mn></mrow></msub></mtd></mtr><mtr><mtd><msub><mi>A</mi><mrow><mi>z</mi><mn>3</mn></mrow></msub></mtd></mtr></mtable></mfenced><mtext>=</mtext><mfenced open='[' close=']'><mtable><mtr><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mi>g</mi></mtd></mtr></mtable></mfenced><mo>;</mo></mrow>]]></math><img file="FDA0000722353280000017.GIF" wi="319" he="268" /></maths>六、操作三轴转台使光纤陀螺三轴定位于南偏西45°、东偏南45°、天向位置,采集N组光纤陀螺输出数据,在此位置时捷联惯导系统任一时刻的输入角速率及输入加速度分别为:<img file="FDA0000722353280000018.GIF" wi="640" he="271" /><maths num="0004" id="cmaths0004"><math><![CDATA[<mrow><mfenced open='[' close=']'><mtable><mtr><mtd><msub><mi>A</mi><mrow><mi>x</mi><mn>4</mn></mrow></msub></mtd></mtr><mtr><mtd><msub><mi>A</mi><mrow><mi>y</mi><mn>4</mn></mrow></msub></mtd></mtr><mtr><mtd><msub><mi>A</mi><mrow><mi>z</mi><mn>4</mn></mrow></msub></mtd></mtr></mtable></mfenced><mtext>=</mtext><mfenced open='[' close=']'><mtable><mtr><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mo>-</mo><mi>g</mi></mtd></mtr></mtable></mfenced><mo>;</mo></mrow>]]></math><img file="FDA0000722353280000019.GIF" wi="355" he="272" /></maths>七、将步骤三至六中捷联惯导系统输入角速率代入到光纤陀螺误差数学模型中,得到光纤陀螺零位误差:<maths num="0005" id="cmaths0005"><math><![CDATA[<mrow><mfenced open='{' close=''><mtable><mtr><mtd><msub><mi>D</mi><mrow><mi>x</mi><mn>0</mn></mrow></msub><mo>=</mo><mfrac><mrow><mi>&Sigma;</mi><msub><mi>N</mi><mrow><mi>gx</mi><mn>1</mn></mrow></msub><mo>+</mo><mi>&Sigma;</mi><msub><mi>N</mi><mrow><mi>gx</mi><mn>2</mn></mrow></msub><mo>+</mo><mi>&Sigma;</mi><msub><mi>N</mi><mrow><mi>gx</mi><mn>3</mn></mrow></msub><mo>+</mo><mi>&Sigma;</mi><msub><mi>N</mi><mrow><mi>gx</mi><mn>4</mn></mrow></msub></mrow><mrow><mn>4</mn><mi>N</mi></mrow></mfrac></mtd></mtr><mtr><mtd><msub><mi>D</mi><mrow><mi>y</mi><mn>0</mn></mrow></msub><mo>=</mo><mfrac><mrow><mi>&Sigma;</mi><msub><mi>N</mi><mrow><mi>gy</mi><mn>1</mn></mrow></msub><mo>+</mo><mi>&Sigma;</mi><msub><mi>N</mi><mrow><mi>gy</mi><mn>2</mn></mrow></msub><mo>+</mo><mi>&Sigma;</mi><msub><mi>N</mi><mrow><mi>gy</mi><mn>3</mn></mrow></msub><mo>+</mo><mi>&Sigma;</mi><msub><mi>N</mi><mrow><mi>gy</mi><mn>4</mn></mrow></msub></mrow><mrow><mn>4</mn><mi>N</mi></mrow></mfrac></mtd></mtr><mtr><mtd><msub><mi>D</mi><mrow><mi>z</mi><mn>0</mn></mrow></msub><mo>=</mo><mfrac><mrow><mi>&Sigma;</mi><msub><mi>N</mi><mrow><mi>gz</mi><mn>1</mn></mrow></msub><mo>+</mo><mi>&Sigma;</mi><msub><mi>N</mi><mrow><mi>gz</mi><mn>2</mn></mrow></msub><mo>+</mo><mi>&Sigma;</mi><msub><mi>N</mi><mrow><mi>gz</mi><mn>3</mn></mrow></msub><mo>+</mo><mi>&Sigma;</mi><msub><mi>N</mi><mrow><mi>gz</mi><mn>4</mn></mrow></msub></mrow><mrow><mn>4</mn><mi>N</mi></mrow></mfrac></mtd></mtr></mtable></mfenced><mo>;</mo></mrow>]]></math><img file="FDA0000722353280000021.GIF" wi="1053" he="532" /></maths>式中,D<sub>x0</sub>、D<sub>y0</sub>、D<sub>z0</sub>分别为三个轴光纤陀螺的零位误差;N<sub>gxi</sub>、N<sub>gyi</sub>、N<sub>gzi</sub>,(i=1,2,3,4)分别为步骤三至六中捷联惯导系统光纤陀螺x轴、y轴、z轴的输出;八、将步骤三至六中捷联惯导系统输入加速度代入到石英挠性加速度计误差数学模型中,得到加速度计零位误差:<maths num="0006" id="cmaths0006"><math><![CDATA[<mrow><mfenced open='{' close=''><mtable><mtr><mtd><msub><mi>D</mi><mrow><mi>ax</mi><mn>0</mn></mrow></msub><mo>=</mo><mfrac><mrow><mi>&Sigma;</mi><msub><mi>N</mi><mrow><mi>ax</mi><mn>1</mn></mrow></msub><mo>+</mo><mi>&Sigma;</mi><msub><mi>N</mi><mrow><mi>ax</mi><mn>2</mn></mrow></msub><mo>+</mo><mi>&Sigma;</mi><msub><mi>N</mi><mrow><mi>ax</mi><mn>3</mn></mrow></msub><mo>+</mo><mi>&Sigma;</mi><msub><mi>N</mi><mrow><mi>ax</mi><mn>4</mn></mrow></msub></mrow><mrow><mn>4</mn><mi>N</mi></mrow></mfrac><mo>-</mo><msub><mi>K</mi><mrow><mi>ax</mi><mn>2</mn></mrow></msub><msup><msub><mi>Q</mi><mi>zx</mi></msub><mn>2</mn></msup><msup><mi>g</mi><mn>2</mn></msup></mtd></mtr><mtr><mtd><msub><mi>D</mi><mrow><mi>ay</mi><mn>0</mn></mrow></msub><mo>=</mo><mfrac><mrow><mi>&Sigma;</mi><msub><mi>N</mi><mrow><mi>ay</mi><mn>1</mn></mrow></msub><mo>+</mo><mi>&Sigma;</mi><msub><mi>N</mi><mrow><mi>ay</mi><mn>2</mn></mrow></msub><mo>+</mo><mi>&Sigma;</mi><msub><mi>N</mi><mrow><mi>ay</mi><mn>3</mn></mrow></msub><mo>+</mo><mi>&Sigma;</mi><msub><mi>N</mi><mrow><mi>ay</mi><mn>4</mn></mrow></msub></mrow><mrow><mn>4</mn><mi>N</mi></mrow></mfrac><mo>-</mo><msub><mi>K</mi><mrow><mi>ay</mi><mn>2</mn></mrow></msub><msup><msub><mi>Q</mi><mi>zy</mi></msub><mn>2</mn></msup><msup><mi>g</mi><mn>2</mn></msup></mtd></mtr><mtr><mtd><msub><mi>D</mi><mrow><mi>az</mi><mn>0</mn></mrow></msub><mo>=</mo><mfrac><mrow><mi>&Sigma;</mi><msub><mi>N</mi><mrow><mi>az</mi><mn>1</mn></mrow></msub><mo>+</mo><mi>&Sigma;</mi><msub><mi>N</mi><mrow><mi>az</mi><mn>2</mn></mrow></msub><mo>+</mo><mi>&Sigma;</mi><msub><mi>N</mi><mrow><mi>az</mi><mn>3</mn></mrow></msub><mo>+</mo><mi>&Sigma;</mi><msub><mi>N</mi><mrow><mi>az</mi><mn>4</mn></mrow></msub></mrow><mrow><mn>4</mn><mi>N</mi></mrow></mfrac><mo>-</mo><msub><mi>K</mi><mrow><mi>az</mi><mn>2</mn></mrow></msub><msup><msub><mi>Q</mi><mi>zz</mi></msub><mn>2</mn></msup><msup><mi>g</mi><mn>2</mn></msup></mtd></mtr></mtable></mfenced><mo>;</mo></mrow>]]></math><img file="FDA0000722353280000022.GIF" wi="1377" he="530" /></maths>式中,D<sub>ax0</sub>、D<sub>ay0</sub>、D<sub>az0</sub>分别为三个轴加速度计的零位误差;N<sub>axi</sub>、N<sub>ayi</sub>、N<sub>azi</sub>,(i=1,2,3,4)分别为步骤三至六中捷联惯导系统加速度计x轴、y轴、z轴、的输出;K<sub>ax2</sub>、K<sub>ay2</sub>、K<sub>az2</sub>分别为三个轴加速度计的二次非线性误差;Q<sub>IJ</sub>,(I,J=X,Y,Z)分别为加速度计三个轴的不正交度误差。
地址 150001 黑龙江省哈尔滨市南岗区南通大街145号