发明名称 微机械陀螺惯性测量组件的闭环标定方法
摘要 本发明提供的是一种微机械陀螺惯性测量组件的闭环标定方法。包括:采集陀螺仪和加速度计输出的数据;粗略测量Y轴的标度因数;用粗略确定的标度因数、安装误差构成矩阵CKg_b;微机械捷联惯性导航系统按照罗经回路法进行对准,在罗经对准结束后读取系统导航参数输出航向角,地理坐标系各轴上的控制角速度,由此测量出陀螺的常值漂移;系统进入导航阶段,精确标定陀螺的标度因数和安装误差角;将更新矩阵CKg_b和航向角写入导航计算机,进行下一轮标定,当两次标定得到的航向角之差小于给定的常数0.0001°时标定结束。使用本发明提供的标定方法,系统处于闭环反馈状态,能够对标定误差进行反馈修正,从而提高了标定精度。
申请公布号 CN101246023A 申请公布日期 2008.08.20
申请号 CN200810064149.0 申请日期 2008.03.21
申请人 哈尔滨工程大学 发明人 周广涛;奔粤阳;高伟;徐博;陈世同;于强;高洪涛;吴磊;程建华;张鑫
分类号 G01C25/00(2006.01);G01C21/16(2006.01) 主分类号 G01C25/00(2006.01)
代理机构 代理人
主权项 1、一种微机械陀螺惯性测量组件的闭环标定方法,其特征是:步骤1、将微机械陀螺测量组件放置于转台上,陀螺测量组件的X、Y、Z轴陀螺的主轴分别与转台的内、中、外框的自转轴平行,捷联惯性导航系统进行预热,然后采集陀螺仪和加速度计输出的数据;步骤2、操作转台使捷联惯性导航系统调整到当地地理坐标系上,再将Y轴向北抬高一个角度,该角度等于纬度值<img file="S2008100641490C00011.GIF" wi="52" he="34" />使Y轴正方向分别对准地球自转角速率的正方向与负方向,记录陀螺原始输出N<sub>g</sub><sup>+</sup>、N<sub>g</sub><sup>-</sup>,粗略测量Y轴的标度因数为<maths num="0001"><![CDATA[<math><mrow><msub><mi>K</mi><mi>gy</mi></msub><mo>=</mo><mn>2</mn><msub><mi>&omega;</mi><mi>ie</mi></msub><mo>/</mo><mrow><mo>(</mo><msubsup><mi>N</mi><mi>gy</mi><mo>+</mo></msubsup><mo>-</mo><msubsup><mi>N</mi><mi>gy</mi><mo>-</mo></msubsup><mo>)</mo></mrow></mrow></math>]]></maths>用同样的方法,求出另外两个轴的标度因数K<sub>gx</sub>和K<sub>gz</sub>分别为<maths num="0002"><![CDATA[<math><mrow><msub><mi>K</mi><mi>gx</mi></msub><mo>=</mo><mn>2</mn><msub><mi>&omega;</mi><mi>ie</mi></msub><mo>/</mo><mrow><mo>(</mo><msubsup><mi>N</mi><mi>gx</mi><mo>+</mo></msubsup><mo>-</mo><msubsup><mi>N</mi><mi>gx</mi><mo>-</mo></msubsup><mo>)</mo></mrow></mrow></math>]]></maths><maths num="0003"><![CDATA[<math><mrow><msub><mi>K</mi><mi>gz</mi></msub><mo>=</mo><mn>2</mn><msub><mi>&omega;</mi><mi>ie</mi></msub><mo>/</mo><mrow><mo>(</mo><msubsup><mi>N</mi><mi>gz</mi><mo>+</mo></msubsup><mo>-</mo><msubsup><mi>N</mi><mi>gz</mi><mo>-</mo></msubsup><mo>)</mo></mrow><mo>;</mo></mrow></math>]]></maths>步骤3、粗略确定微机械陀螺的零位误差与安装误差,用粗略确定的标度因数、安装误差构成矩阵CKg_b<maths num="0004"><![CDATA[<math><mrow><mi>CKg</mi><mo>_</mo><mi>b</mi><mo>=</mo><mfenced open='(' close=')'><mtable><mtr><mtd><mn>1</mn><mo>/</mo><msub><mi>K</mi><mi>gx</mi></msub></mtd><mtd><msub><mi>&delta;&theta;</mi><mi>yx</mi></msub></mtd><mtd><msub><mi>&delta;&theta;</mi><mi>zx</mi></msub></mtd></mtr><mtr><mtd><msub><mi>&delta;&theta;</mi><mi>xy</mi></msub></mtd><mtd><mn>1</mn><mo>/</mo><msub><mi>K</mi><mi>gy</mi></msub></mtd><mtd><msub><mi>&delta;&theta;</mi><mi>zy</mi></msub></mtd></mtr><mtr><mtd><msub><mi>&delta;&theta;</mi><mi>xz</mi></msub></mtd><mtd><msub><mi>&delta;&theta;</mi><mi>yz</mi></msub></mtd><mtd><mn>1</mn><mo>/</mo><msub><mi>K</mi><mi>gz</mi></msub></mtd></mtr></mtable></mfenced></mrow></math>]]></maths>即CKg_b确定了微机械陀螺的标度因数和安装误差角;步骤4、由步骤3确定的CKg_b矩阵与粗略确定的零位误差写入导航计算机中,捷联惯性导航系统按照罗经回路法进行对准,在罗经对准结束后读取系统导航参数输出航向角<img file="S2008100641490C00016.GIF" wi="57" he="49" />地理坐标系各轴上的控制角速度,由此测量出陀螺的常值漂移;步骤5、由步骤4确定的陀螺的常值漂移写入导航计算机中进行补偿,随后,捷联惯性导航系统进入导航阶段,记录陀螺的输出,并观察捷联惯性导航系统解算得到的航向角,精确标定陀螺的标度因数和安装误差角;步骤6、由步骤5确定的修正陀螺标度因数和安装误差角更新矩阵CKg_b,以及导航解算得到的航向角写入导航计算机作为下一轮标定的初值,重复步骤4、步骤5的过程,最后,当两次标定得到的航向角之差小于给定的常数0.0001°时,即航向角误差Δψ不再发生变化时标定结束。
地址 150001黑龙江省哈尔滨市南岗区南通大街145号1号楼哈尔滨工程大学科技处知识产权办公室
您可能感兴趣的专利