专利名称：应用零速/航向修正的光纤捷联惯组在线标定方法
技术领域：
本发明属于惯性技术领域，具体涉及一种应用零速/航向修正的光纤捷联惯组在线标定方法。
背景技术：
光纤陀螺是以SAGNAC效应为基本原理的角速率传感器。与传统的机械陀螺相比，光纤陀螺具有结构简单，性能稳定、动态范围宽、瞬时响应、可承受大过载、价格相对较低、寿命长等优点，受到各国厂家和用户的普遍关注，发展相当迅速。光纤捷联惯组一般由三个光纤陀螺、三个石英挠性加速度计及系统相关电路组
成。光纤捷联惯组在进入导航解算状态前一般要首先完成初始对准过程。初始对准误差是光纤捷联惯性导航系统主要的测量误差，载体相对于导航坐标系初始姿态的测量精度直接影响着导航参数的精度。惯导系统的静基座对准是保证系统工作精度的前提。静基座对准是指在载体静止的情况下光纤捷联惯导系统进行初始对准，通�？梢圆捎媒馕鍪蕉宰挤椒�、罗经回路对准方法、方位估算方法、两位置卡尔曼滤波对准法等。在两位置卡尔曼滤波对准过程中，一般集中在对方位失准角的估计，同时还能观测一部分陀螺漂移误差。在实际工程应用中，如果能够通过建立合理的光纤惯组误差模型，并且充分利用起竖两位置对准过程中的零速信息以及外部光学瞄准获取的航向角信息，将光纤惯组的主要误差项分离出来，对于提高光纤惯组主要误差参数的辨识精度以及光纤惯组实际导航性能将具有非常重要的军事意义和实用价值。申请号为200810064146. 7的发明专利公开了一种基于滤波的光纤陀螺捷联惯导系统两位置初始对准方法，所述的对准方法为了解决载体在静止状态下，地理坐标系下的东向光纤陀螺漂移不可观测，导致方位失准角的可观测度难以提高的问题，提出采用卡尔曼滤波在载体的两个不同方位上估计姿态角，进而通过估计的姿态角计算出水平方向的陀螺漂移并在对准的最后阶段加以补偿。申请号为200510130615. 7的发明专利公开了一种捷联惯性导航系统的任意双位置初始对准方法，根据该方法，可以将SINS从初始位置旋转到任意一个位置，利用两个位置上SINS的输出与地球自转角速度和重力加速度的关系，可确定SINS的初始姿态，并且可以测量出陀螺仪的常值漂移。上述两种对准方法的缺点是，只能估算陀螺漂移误差，没有考虑光纤惯组安装误差、标度误差等，惯组精度提高有限，从而限制了惯组的实际导航性能。
发明内容
本发明的目的在于充分利用载体起竖两位置对准过程，采用基于零速修正和航向修正的滤波方法实现光纤惯组漂移误差、标度误差、安装误差等在内的主要误差源的标定，提高光纤惯组的实际使用精度。
本发明提供一种应用零速/航向修正的光纤捷联惯组在线标定方法，包括如下步骤步骤I、确定载体的初始位置参数，并将其装订至导航计算机；步骤2、光纤捷联惯组系统进行预热，然后采集光纤陀螺仪和石英加速度计的输出数据；步骤3、光纤捷联惯组系统粗对准，确定载体的姿态；步骤4、粗对准结束后进入精对准阶段，保持载体在水平位置上静止不动，只作零速修正，对准时间不少于250秒，此时光纤捷联惯组初始俯仰角和滚转角分别设为O度和-45度，航向角为45度；精对准过程包括建立精对准的系统状态方程和量测方程，以及卡尔曼滤波状态估计； 步骤5、载体从水平位置绕俯仰轴在水平面的投影旋转至竖直位置；步骤6、保持载体在竖直位置上静止不动，作零速修正和航向修正，对准时间不少于200秒。所述的初始位置参数为载体的经度、纬度和高度参数。本发明的优点在于可以对光纤捷联惯组各主要误差项进行标定，从而提高系统的参数辨识精度和光纤捷联惯组的实际导航性能。
图I为本发明中卡尔曼滤波的反馈校正方式示意图；图2为本发明的应用零速/航向修正的光纤捷联惯组在线标定方法的流程图；图3a 3f为本发明中基于两位置对准方式下光纤捷联惯组各状态变量估计仿真曲线。
具体实施例方式下面结合附图和实施例对本发明进行详细说明。本发明提供了一种应用零速/航向修正的光纤捷联惯组在线标定方法，所述的标定方法将光纤捷联惯组的标度误差、安装误差作为增广状态变量添加进卡尔曼滤波器，对卡尔曼滤波器的状态变量进行设计时，状态变量中除包含了常值漂移误差项外，还包含了器件标度误差以及安装误差项；充分利用两位置对准过程的零速信息以及通过光学瞄准得到的航向信息对各主要误差进行估计和补偿，减小惯组误差对系统精度的影响。所述的标定方法流程如图2所示，具体包括如下步骤步骤I、通过外部设备(例如GPS接收机)可确定载体的初始位置参数(包括初始的经度、纬度和高程)，并将其装订至导航计算机。步骤2、光纤捷联惯组系统进行预热，然后采集光纤陀螺仪和石英加速度计的输出数据。步骤3、光纤捷联惯组系统粗对准，确定载体的姿态。根据光纤捷联惯组系统的误差传播特性和古典控制理论，采用二阶调平法和方位估算法来完成系统的粗对准，初步确定载体的姿态。粗对准时间不少于30秒。所述的古典控制理论参见参考文献[3](万德钧，房建成，《惯性导航初始对准》，东南大学出版社，1998年12月，第36 82页)。步骤4、粗对准结束后进入精对准阶段。保持载体在水平位置上静止不动，只作零速修正，不作航向修正，对准时间不少于250秒。此时光纤捷联惯组初始俯仰角和滚转角分别设为O度和-45度，航向角为45度。精对准过程包括建立精对准的系统状态方程和量测方程，以及卡尔曼滤波状态估计。(I)导航坐标系取为游动自由方位坐标系。建立系统状态方程和量测方程如下
权利要求
1.应用零速/航向修正的光纤捷联惯组在线标定方法，其特征在于 步骤I、确定载体的初始位置参数，并将其装订至导航计算机； 步骤2、光纤捷联惯组系统进行预热，然后采集光纤陀螺仪和石英加速度计的输出数据； 步骤3、光纤捷联惯组系统粗对准，确定载体的姿态； 步骤4、粗对准结束后进入精对准阶段，保持载体在水平位置上静止不动，只作零速修正，对准时间不少于250秒，此时光纤捷联惯组初始俯仰角和滚转角分别设为O度和-45度，航向角为45度；精对准过程包括建立精对准的系统状态方程和量测方程，以及卡尔曼滤波状态估计； 步骤5、载体从水平位置绕俯仰轴在水平面的投影旋转至竖直位置； 步骤6、保持载体在竖直位置上静止不动，作零速修正和航向修正，对准时间不少于200 秒。
2.根据权利要求I所述的应用零速/航向修正的光纤捷联惯组在线标定方法，其特征在于所述的初始位置参数为载体的经度和纬度参数。
3.根据权利要求I所述的应用零速/航向修正的光纤捷联惯组在线标定方法，其特征在于步骤4中的水平位置静对准过程如下 (I)导航坐标系取为游动自由方位坐标系，建立系统状态方程和量测方程如下
4.根据权利要求I所述的应用零速/航向修正的光纤捷联惯组在线标定方法，其特征在于所述的水平位置转换为竖直位置，具体为载体绕俯仰轴在水平面投影旋转角度设定为88度，转速为I度/秒。
全文摘要
本发明公开了一种应用零速/航向修正的光纤捷联惯组在线标定方法，属于惯性技术领域。本发明充分利用载体起竖两位置对准过程，采用基于零速修正和航向修正的滤波方法实现光纤惯组漂移误差、标度误差、安装误差等在内的主要误差源的标定，提高光纤惯组的实际使用精度。本发明通过确定载体的初始位置参数，采集光纤陀螺仪和石英加速度计的输出数据；粗对准确定载体的姿态；水平位置和竖直位置精对准，实现在线标定。本发明可以对光纤捷联惯组各主要误差项进行标定，从而提高系统的参数辨识精度和光纤捷联惯组的实际导航性能。
文档编号G01C25/00GK102680000SQ20121012682
公开日2012年9月19日 申请日期2012年4月26日 优先权日2012年4月26日
发明者宋来亮, 张春熹, 李保国, 芦佳振 申请人:北京航空航天大学
专业数控铣床产品供应商
20年生产经验，实力工厂，精工品质，质量有保障
