【技术实现步骤摘要】
一种基于组合导航技术的船用光纤捷联惯导系统的在线标定方法
本专利技术属于导航
,尤其涉及一种基于组合导航技术的船用光纤捷联惯导系统的在线标定方法。
技术介绍
近年来,海洋事业发展迅速,对船用捷联惯导系统的性能的要求越来越高。惯性测量组件误差约占系统误差的90%左右,即只有保证惯性测量组件的高精度,才能保证惯导系统的高精度。惯性系统的性能指标下降,导致不能满足导航的精度要求,因此必须通过各种方法提高精度。目前,提高惯性器件精度主要从硬件和软件两个方面入手。(1)硬件层面:一是对现有的陀螺仪和加速度计进行深加工;二是当科学技术更加成熟的时候,有新型的材料能够取代现有的材料,并且新材料的性能非常卓越。(2)软件层面:深入研究惯性导航系统的算法,建立更加精准的系统模型,通过软件对系统进行标定,得到精度较高的误差数据,补偿进入惯性导航系统中,从而提高系统的输出精度。在惯性器件的精度达到一定程度的时候,通过软件的补偿继续提高精度成为首要选择,也能够有效的降低投入成本。当前针对光纤陀螺等惯性测量组件的误差,一般都在实验室通过角增量实验、位置实验和零位误差修正实验进行分立式标定。但是惯性组件安装完成之后,环境的改变和时间的迁移会使误差参数与分立式标定的结果不一致,这会导致捷联惯导系统的精度降低。而频繁拆卸捷联惯导系统进行分立式标定会带来巨大的经济损失和工程实用负担。
技术实现思路
专利技术目的:为解决现有技术存在的问题,本专利技术提出一种基于组合导航技术的船用光纤捷联惯导系统的在线标定方法,避免了光纤陀螺捷联惯性导航系统定期拆卸标定,有效提高光纤捷联惯导系统精度。技术方 ...
【技术保护点】
一种基于组合导航技术的船用光纤捷联惯导系统的在线标定方法,其特征在于,根据船用的主导航系统提供的位置、速度和航向信息对船用光纤捷联的子惯导系统的惯性测量组件误差进行在线标定;其包括如下具体步骤:步骤1:建立光纤陀螺、加速度计的输出误差模型;步骤2:建立子惯导系统的位置、速度、姿态误差方程;步骤3:通过子惯导系统解算的位置、速度、姿态信息和陀螺加速度计常值漂移、刻度因数误差、安装误差这些惯性测量组件误差参数作为滤波器状态量,应用模型预测滤波和自适应扩展卡尔曼滤波组合滤波的方法建立状态方程;步骤4:以子惯导系统解算的位置、速度、航向信息和主导航系统提供的位置、速度、航向信息的差值作为滤波器的量测量,建立量测方程;步骤5:在步骤3建立的状态方程的基础上,根据模型预测滤波计算模型误差
【技术特征摘要】
1.一种基于组合导航技术的船用光纤捷联惯导系统的在线标定方法,其特征在于,根据船用的主导航系统提供的位置、速度和航向信息对船用光纤捷联的子惯导系统的惯性测量组件误差进行在线标定;其包括如下具体步骤:步骤1:建立光纤陀螺、加速度计的输出误差模型;步骤2:建立子惯导系统的位置、速度、姿态误差方程;步骤3:通过子惯导系统解算的位置、速度、姿态信息和陀螺加速度计常值漂移、刻度因数误差、安装误差这些惯性测量组件误差参数作为滤波器状态量,应用模型预测滤波和自适应扩展卡尔曼滤波组合滤波的方法建立状态方程;步骤4:以子惯导系统解算的位置、速度、航向信息和主导航系统提供的位置、速度、航向信息的差值作为滤波器的量测量,建立量测方程;步骤5:在步骤3建立的状态方程的基础上,根据模型预测滤波计算模型误差从而修正一步预测状态量实现在线实时修正系统模型;步骤6:采用Sage-Husa自适应扩展卡尔曼滤波,通过步骤4建立的量测方程和观测量中的航向、速度和位置信息对设定的量测噪声方差阵R进行估计和修正,得到估计状态的最优值;步骤7:根据步骤5推导出的一步预测状态量结合步骤6中采用的Sage-Husa自适应扩展卡尔曼滤波,实现时间更新和量测更新,对步骤3中的滤波器状态量进行估计,用模型预测滤波修正自适应扩展卡尔曼滤波的状态一步预测值,得到子惯导系统中系统状态各项参数值,实现误差的估计与校正。2.如权利要求1所述的基于组合导航技术的船用光纤捷联惯导系统的在线标定方法,其特征在于,所述步骤1中建立光纤陀螺、加速度计的输出误差模型具体为:将光纤陀螺的安装误差、刻度系数误差和常值漂移建入光纤陀螺误差模型,得:式中,n为导航坐标系;b为载体坐标系;i为惯性坐标系;εn为载体坐标系下常值漂移;为从载体坐标系至导航坐标系的变换矩阵;为陀螺的输出;[δKG]为陀螺的刻度系数误差,[δG]为安装误差,将加速度计的安装误差、刻度系数误差和常值漂移建入加速度计误差模型,得:式中,为导航坐标系下常值漂移;fb为加速度计的输出;[δKA]为加速度计的刻度系数误差,[δA]为安装误差,3.如权利要求1所述的基于组合导航技术的船用光纤捷联惯导系统的在线标定方法,其特征在于,所述步骤2中建立子惯导系统的位置、速度、姿态误差方程的过程为:建立姿态误差方程为:式中,εn、δKGi和δGi(i=x,y,z)分别为光纤陀螺的常值漂移、刻度系数误差和安装误差;φ为姿态误差角矢量;为导航坐标系相对惯性坐标系的角速度在导航坐标系下的投影;为导航坐标系相对惯性坐标系转动角速度计算误差;建立速度误差方程为:式中,φn为导航坐标系下姿态误差角;fb为载体坐标系下加速度计的输出;fn为导航坐标系下加速度计的输出;δKAi和δAi(i=x,y,z)分别为加速度计的常值漂移、刻度系数误差和安装误差;建立位置误差方程为:式中,δVE、δVN为东北向速度误差;RN为沿卯酉圈的曲率半径;RM沿子午圈的曲率半径;λ为经度;L为纬度。4.如权利要求1所述的基于组合导航技术的船用光纤捷联惯导系统的在线标定方法,其特征在于,所述步骤3中通过子惯导系统解算的位置、速度、姿态信息和陀螺加速度计常值漂移、刻度因数误差、安装误差这些惯性测量组件误差参数作为滤波器状态量,应用模型预测滤波和自适应扩展卡尔曼滤波组合滤波的方法建立状态方程具体为:式中,D=[δGxδGyδGzδKGxδKGyδKGzδAxδAyδKAxδKAy]。式中:φE、φN、φU——东北天失准角δVE、δVN——东北向速度误差δL、δλ——经纬度误差εi(i=x,y,z)——光纤陀螺的陀螺零偏——X、Y的加速度计常值漂移δKGi(i=x,y,z)——光纤陀螺的...
【专利技术属性】
技术研发人员:徐晓苏,吴梅,王捍兵,金博楠,
申请(专利权)人:东南大学,
类型:发明
国别省市:江苏,32
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。