一种基于最小二乘拟合的光纤捷联惯导系统现场标定方法
【专利摘要】本发明公开了一种基于最小二乘拟合的光纤捷联惯导系统现场标定方法，属于惯性【技术领域】。本发明采用9次翻转路径设计，对系统输出惯性数据应用最小二乘拟合的方法求解得到光纤捷联惯导系统18项误差系数；再通过一次翻转得到零偏误差，进而得到全部21项器件误差参数；本发明提供的技术方案利用六面体或其它相似的可翻转装置即可完成现场标定试验，克服了传统实验室标定的不足，提高了系统实际使用精度。
【专利说明】一种基于最小二乘拟合的光纤捷联惯导系统现场标定方法
【技术领域】
[0001]本发明属于惯性【技术领域】，涉及一种光纤捷联惯导系统现场标定方法，具体地说，是指一种基于最小二乘拟合的光纤捷联惯导系统现场标定方法。
【背景技术】
[0002]光纤陀螺具有精度高、启动快、动态范围大、抗振动冲击能力强及成本低等优点，是惯性仪表领域的发展趋势。近年来，光纤陀螺技术的迅猛发展推动了光纤捷联惯导系统在陆、海、空、天领域的应用。光纤捷联惯导在使用前必须通过实验室转台标定试验确定出其核心部件即光纤陀螺和加速度计的标度因数和各项误差系数，在后续的导航计算中进行补偿。
[0003]但是，通过实验室转台试验标定出的光纤惯导系统各项误差系数并不是固定不变的，包括光纤陀螺零位漂移误差、标度因数、安装误差和加速度计常值误差、标度困数、安装误差等。这些误差参数随着系统使用或存放时间的推移而变化，尤其是光纤陀螺零位漂移和加速度计偏值，每次上电启动都不相同，且时间间隔越长变化越大。光纤陀螺和加速度计误差参数的改变直接导致光纤惯导系统的精度降低，使惯导系统无法使用要求。
[0004]因此，通常需要对光纤惯导系统进行半年或三个月一次的定期标定，而且传统的基于精密转台的标定方法复杂、耗时长，这为使用单位增添了巨大的工作量及人力、物力、财力的消耗。因此，在使用现场对光纤惯导的各项误差系数进行标定，不仅可以减少甚至取消定期标定，还可以提高光纤捷联惯导的实际使用精度。但是，在现场没有精密的转台作为测试基准，不能对充纤陀螺捷联惯导进行精确定向，所以传统的基于精密转台的静态多位置标定方法和速率标定方法都无法实施，为光纤捷联惯导的现场标定带来了极大难度。
[0005]在没有精确的基准设备和复杂的转位机构的情况下，现场标定就不能采用传统的速率位置法，必须依靠系统级方法来克服基准信息缺乏的困难。系统级方法以光纤惯导的导航误差为观测量，通过惯导系统误差参数与导航误差之间的关系，建立惯导系统误差参数与导航误差之间的方程式，进而求解出惯导系统的误差参数。因此，系统级标定方法可以克服使用现场设备条件不足的缺点，并获得高精度的系统误差标定接过。
[0006]参考文献[I](光电工程，刘百奇，房建成.光纤陀螺IMU的六位置旋转现场标定新方法[J].35(1)，2008:60-65)公开了一种光纤陀螺IMU的六位置旋转现场标定新方法，本文采用光纤陀螺MU在六个位置上进行12次旋转，然后根据光纤陀螺IMU的误差模型建立42个非线性输入输出方程，通过旋转积分和对称位置误差相消，消除方程中的非线性项，最终求出陀螺标度因数、陀螺常值漂移、陀螺安装误差和加速度计常值偏置等15个误差系数。但是该方法不能够标定出加速度计通道的标度因数和安装误差。
[0007]参考文献[2](测控技术，颜开思，李岁劳，龚柏春，贾继超.[J].30(5)，2011:106-109)公开了一种基于平台和正六面体的惯导系统现场标定技术，该文献通过翻转正六面体使对称位置误差相消，并且在对准中获取姿态信息，同时精确标定出陀螺漂移和加速度计零偏。最后对理论分析结果进行了仿真验证，仿真结果表明该方案可以实现外场条件下的陀螺漂移和加速度计零偏的精确标定。但是该方法不能够标定出陀螺、加速度的标度因数和安装误差。
[0008]参考文献[3](吴赛成，秦石乔，王省书，胡春生.[J].中国惯性技术学报，19 (2) ,2011:185-189)公开了一种激光陀螺惯性测量单元系统级标定方法，该文献建立了附加约束条件的陀螺和加速度计安装坐标系数学模型，根据陀螺和加速度计的输出误差方程，从惯性导航基本误差方程出发推导了惯性测量单元的系统级误差参数标定Kalman滤波模型，该模型包含了陀螺和加速度计零偏、比例因子、安装误差在内共21维标定误差状态变量，且仅以速度解算误差为观测量。但是该方法标定步骤较多，标定时间过长，缺少实验数据验证。
[0009]参考文献[4](专利文献号CN102607594A)公开了一种捷联惯导光纤陀螺系统误差参数现场标定方法，所述现场标定方法通过姿态测量仪器给出载体姿态角，选取姿态作为观测量，标定出光纤捷联惯导系统光纤陀螺各项误差系数。但是该方法需要现场提供姿态测量辅助器件，实时精确测量载体姿态角，并且要与光纤陀螺输出值保持一致。
【发明内容】
[0010]本发明的目的在于提供一种基于最小二乘拟合的光纤捷联惯导系统现场标定方法，减少或者甚至取消光纤捷联惯导系统周期性地返实验室校标，提高系统实际使用精度。
[0011]本发明采用9次翻转路径设计，包括转动轴、转动顺序和转动角度等；应用最小二乘拟合的方法得到光纤捷联惯导系统全部21项器件误差参数；利用六面体或其它相似的可翻转装置即可完成现场标定试验。具体方法步骤如下:
[0012]第一步:将光纤捷联惯导系统通过工装安装在正六面体装置上，锁紧。连接系统、电源和采集计算机之间的线缆，并检查正确。
[0013]第二步:将正六面体装置置于水平面上，上电预热使光纤捷联惯导系统达到热平衡状态，并装订光纤捷联惯导系统的初始位置参数，包括初始的经度、纬度和高度。
[0014]第三步:采用“静止-转动-静止”进行手动翻转正六面体装置，按照转动路径序列完成9次翻转。转动前后每个位置静止3?5min，并保存9次转动过程中光纤捷联惯导系统输出所有惯性器件数据。
[0015]第四步:对惯性器件误差进行建模。
[0016]第五步:对9组惯性器件数据进行处理，采用最小二乘拟合的方法求解，得到除陀螺零偏以外的其他18项误差系数；
[0017]第六步:根据标定得到18项误差系数，对保存的9组惯性器件数据进行补偿，得到新的9组惯性器件数据。
[0018]第七步:对于第六步中得到的新的9组惯性器件数据，重复第五步和第六步3?5次，即迭代器件18项误差系数值进行重复最小二乘拟合计算，直至收敛。累加每次迭代估计得到器件18项误差系数值，即为最终标定参数值。
[0019]第八步:根据上述标定的18项误差系数，对光纤捷联惯导系统进行补偿。
[0020]第九步:重复第一步到第二步，按照序列I进行手动手动翻转六面体依次，转动前后分别静止时间30min，保存陀螺仪输出数据，基于该输出数据，计算陀螺零偏误差。
[0021]第十步:根据求解得到的三轴陀螺零偏误差对光纤捷联惯导系统误差再次补偿，采用光纤捷联惯导系统输出陀螺值减去标定得到的陀螺零偏值即可，完成了光纤捷联惯导系统21项误差参数的现场标定。
[0022]本发明的有益效果在于:
[0023]本发明所提出的方法可以在现场完成光纤捷联惯导系统21项误差参数的标定，克服了传统实验室标定的不足，提高了系统实际使用精度。
【专利附图】
【附图说明】
[0024]图1为本发明提供的基于最小二乘拟合的光纤捷联惯导系统现场标定方法流程图；
[0025]图2A和图2B分别为本发明实施例中静态和摇摆情况下现场标定补偿前后20min导航定位误差对比曲线。
【具体实施方式】
[0026]下面结合附图和实施例对本发明进行详细说明。
[0027]本发明提供一种基于最小二乘拟合的光纤捷联惯导系统现场标定方法，如图1所示，所述方法包括如下步骤:
[0028]第一步:将光纤捷联惯导系统通过工装安装在正六面体装置上，锁紧。连接系统、电源和采集计算机之间的线缆，并检查正确。
[0029]第二步:将正六面体装置置于水平面上，上电预热使光纤捷联惯导系统达到热平衡状态，并装订光纤捷联惯导系统的初始位置参数，包括初始的经度、纬度和高度。
[0030]第三步:按照表1转动路径序列，表1中转动轴X、Y、Z，光纤捷联惯导系统初始姿态为O时，光纤捷联惯导系统XYZ轴与导航坐标系东北天位置重合。
[0031]采用“静止-转动-静止”进行手动翻转正六面体装置，完成9次翻转，转动角允许存在±10°误差。转动前后每个位置静止3~5min，并保存9次转动过程中光纤捷联惯导系统输出所有惯性器件数据。
[0032]表1最小二乘拟合法转动路径序列(转动角单位:度)[0033]
【权利要求】
1.一种基于最小二乘拟合的光纤捷联惯导系统现场标定方法，其特征在于通过如下步骤实现: 第一步:将光纤捷联惯导系统通过工装安装在正六面体装置上，锁紧；连接系统、电源和采集计算机之间的线缆，并检查正确； 第二步:将正六面体装置置于水平面上，上电预热使光纤捷联惯导系统达到热平衡状态，并装订光纤捷联惯导系统的初始位置参数，包括初始的经度、纬度和高度； 第三步:采用“静止-转动-静止”进行手动翻转正六面体装置，按照转动路径序列完成9次翻转；转动前后每个位置静止3~5min，并保存9次转动过程中光纤捷联惯导系统输出所有惯性器件数据；所述转动路径序列如下:
2.根据权利要求1所述的一种基于最小二乘拟合的光纤捷联惯导系统现场标定方法，其特征在于:第三步中所述转动角允许存在±10°误差。
3.根据权利要求1所述的一种基于最小二乘拟合的光纤捷联惯导系统现场标定方法，其特征在于:第四步中所述的对惯性器件误差进行建模，包括光纤陀螺误差模型和加速度计误差模型，分别如下:
4.根据权利要求1所述的一种基于最小二乘拟合的光纤捷联惯导系统现场标定方法，其特征在于:所述最小二乘拟合法包含以下几个步骤: 步骤1:建立器件误差与系统速度误差一阶导数变化量的数学模型:
K·X = A 其中K表示转动系数矩阵，X表示误差向量，A表示观测矩阵；误差向量X= [Xa; Xg]； Xa = [aBx aBy aBz aSFx aMAyx aSFy aMAzx aMAzy aSFjT Xg = [gSFx gMAxy gMAxz gMAyx gSFy gMAyz gMAzx gMAzy gSFjT 式中gSFx、gSFy、gSFz分别表示三轴陀螺仪标度因数误差；gMAxy、gMAxz、gMAyx、gMAyz、gMAzx、gMAzy分别表示各轴陀螺仪间的安装误差角；aSFx、aSFy、aSFz分别为三轴加速度计标度因数误差；aBx、aBy、aBz分别为三轴加速度计零偏；aMAyx、aMAzx、aMAzy分别表示各轴加速度计间安装误差角； 步骤2:求解观测矩阵A ； 观测矩阵A=δV(T2)-δV(T1)，δV(T2)表示T2时刻速度误差一阶导数矢量，δV(T1)表示T1时刻速度误差一阶导数矢量； 观测矩阵由三向速度误差一阶导数组成，光纤捷联惯导系统静止时，速度误差即为光纤捷联惯导系统导航输出的速度值；采用标准卡尔曼滤波计算速度误差一阶导数值； 建立状态方程:
5.根据权利要求1所述的一种基于最小二乘拟合的光纤捷联惯导系统现场标定方法，其特征在于:第六步中所述的对保存的9组惯性器件数据进行补偿，得到新的9组惯性器件数据，其中补偿公式如下:
6.根据权利要求1所述的一种基于最小二乘拟合的光纤捷联惯导系统现场标定方法，其特征在于:计算陀螺零偏误差计算公式如下:
【文档编号】G01C25/00GK103852085SQ201410116682
【公开日】2014年6月11日 申请日期:2014年3月26日 优先权日:2014年3月26日
【发明者】李保国, 芦佳振, 肖文华, 吴孟 申请人:北京航空航天大学
专业数控铣床产品供应商
20年生产经验，实力工厂，精工品质，质量有保障
