一种无误差的光纤陀螺捷联惯导系统速度更新方法技术方案

本发明专利技术提供的是一种无误差的光纤陀螺捷联惯导系统速度更新方法。1.给定初始导航参数；2、设置采样周期h，实时采集三个轴上陀螺和加速度计的输出信号；3、光纤陀螺捷联惯导系统测量船舶tk时刻姿态信息；4.递推测量tk+1时刻旋转坐标系相对于载体坐标系运动的旋转角速度αk+1；5.递推测量tk+1时刻比力积分转换增量

An Error-free Velocity Updating Method for Fiber Optic Gyro Strapdown Inertial Navigation System

【技术实现步骤摘要】
一种无误差的光纤陀螺捷联惯导系统速度更新方法
本专利技术涉及的是一种光纤陀螺捷联惯导的速度更新方法。
技术介绍
在捷联惯性导航系统中，包括两类关键的计算。其一就是更新载体姿态的计算，另一个则是更新载体速度的计算。在姿态更新计算中，如果存在载体角速度向量旋转的情形，就会引入圆锥误差。而在更新载体速度的计算中，情况就更为复杂。因为，要获取载体的速度信息，就需要在导航参考坐标系中对比力信号进行积分。这个积分过程通常分两步进行：首先是将固联在载体系上的加速度计敏感的比力信号用该时刻的姿态方向余弦矩阵转换到导航参考坐标系中，然后是在导航参考坐标系中对比力信号进行积分。由于捷联惯性导航系统中加速度计直接固联在载体上，在速度计算周期内，载体的空间转动使比力改变，速度计算中引入不可交换性误差，这就是速度划船效应。要高质量地完成捷联惯导系统的比力积分，就需要高精度的速度更新方法，它的核心问题是补偿划船误差。因此研究一种适用于光纤陀螺捷联惯导系统的无误差的速度更新算法是必要的。但是在已发表的文章中，如在《兵工学报》第33卷第10期的林玉荣、陈亮、付振宪的一篇《捷联惯导系统两种速度更新算法的比较研究》文章中从理论上研究了传统速度更新算法和对偶四元数速度更新算法的不同之处，并通过定义两类误差，对二者之间的精度差别做出了定性的表征，同时也给出了定量的分析。从其仿真的结果看，对偶四元数速度更新算法对不可交换误差的抑制能力明显优于传统速度更新算法。但是，与传统速度更新算法相比，对偶四元数速度更新算法是用计算量换来精度上的优势。还有律新伟、薛宁、贾龙、李焱焱在《航天控制》上发表的《光纤陀螺捷联惯导划桨运动补偿》文章中提出了适合光纤陀螺捷联惯导系统的以角速率为输入信号的划桨补偿算法，并以算法漂移误差最小为优化原则对算法进行了优化，推导了相应的划桨补偿系数方程和算法误差表达式。从其仿真的结果看，所设计的算法比常规角增量划船补偿算法在补偿精度上有明显提高。以上已发表的文章都对捷联惯导的速度更新算法进行了叙述和探究，但是以上不可交换误差补偿多子样算法都是在等效旋转矢量方程进行二阶近似的基础上推导的，本质上存在原理性误差特别是在高动态环境下计算误差不容忽略，即使考虑等效旋转矢量方程高阶近似，依然存在原理性误差，且高阶补偿算法的推导过程非常复杂。因此研究一种适用于光纤陀螺捷联惯导系统的无误差的速度更新方法具有创新性和实际工程价值。
技术实现思路
本专利技术的目的在于提供一种能够提高速度更新精度的无误差的光纤陀螺捷联惯导系统速度更新方法。本专利技术的目的是这样实现的：步骤1.给定初始导航参数：光纤陀螺捷联惯导系统初始对准得到初始纵摇姿态角θ0、初始横摇姿态角γ0、初始方位角ψ0；步骤2、设置采样周期h，实时采集三个轴上陀螺和加速度计的输出信号；速度解算周期H，速度解算周期循环标志k，即tk到tk+1时间段代表一个速度解算周期H，速度解算周期等于系统采样周期，即H＝h；步骤3、光纤陀螺捷联惯导系统测量船舶tk时刻姿态信息，所述姿态信息包括tk时刻的纵摇角θk、tk时刻的横摇角γk、tk时刻的艏摇角ψk，再由姿态信息构成tk时刻载体坐标系b与地理坐标系n的关系矩阵步骤4.递推测量tk+1时刻旋转坐标系相对于载体坐标系运动的旋转角速度αk+1，即tk时刻陀螺输出角速度ωk和tk+1时刻陀螺输出角速度ωk+1利用矢量叉乘法计算得到tk+1时刻旋转坐标系s相对于载体坐标系b运动的旋转角速度αk+1为其中sin-1(·)代表·的反正弦值，|·|代表·的模值，×代表矢量叉乘；步骤5.递推测量tk+1时刻比力积分转换增量即利用tk时刻的陀螺输出ωk和加速度计输出fk，步骤3得到的tk时刻载体坐标系b与地理坐标系n的关系矩阵步骤4得到的tk+1时刻旋转坐标系相对于载体坐标系运动的旋转角速度αk+1计算得到tk+1时刻比力积分转换增量步骤6.递推测量tk+1时刻重力/互补速度增量即利用tk时刻的速度tk时刻的地球自转角速度tk时刻的地理坐标系相对惯性坐标系的旋转角速度和tk时刻的重力加速度在地理坐标系的投影计算得到tk+1时刻重力/互补速度增量其中e代表地球坐标系，i代表惯性坐标系；步骤7.递推测量tk+1时刻的速度即利用tk时刻的速度步骤5得到的tk+1时刻比力积分转换增量和步骤6得到的tk+1时刻重力/互补速度增量计算得到tk+1时刻的速度至此就得到了tk+1时刻的速度完成捷联惯导系统速度更新。本专利技术的优点主要体现在：针对光纤陀螺捷联惯导系统速度更新的问题，本专利技术提供了一种无误差的速度更新方法，在不增加硬件成本的情况下大幅度提高了速度更新的精度，并为下一步的位置更新提供了较高的精度。附图说明图1为本专利技术的适用于光纤陀螺捷联惯性导航系统无误差的速度更新方法流程图。图2为速度更新周期在时间上的分布关系示意图。图3为误差比较表。具体实施方式下面举例对本专利技术做更详细的描述。结合图1，本专利技术的无误差的光纤陀螺捷联惯导系统速度更新方法的第一种实施方式主要包括如下步骤：步骤1.给定初始导航参数(t＝0时刻)；步骤2、设置采样周期h，实时采集三个轴上陀螺和加速度计的输出信号；步骤3、光纤陀螺捷联惯导系统测量船舶tk时刻姿态信息，所述姿态信息包括tk时刻的纵摇角θk、tk时刻的横摇角γk、tk时刻的艏摇角ψk，再由姿态信息构成tk时刻载体坐标系b与地理坐标系n的关系矩阵；步骤4.递推测量tk+1时刻旋转坐标系相对于载体坐标系运动的旋转角速度αk+1；步骤5.递推测量tk+1时刻比力积分转换增量步骤6.递推测量tk+1时刻重力/互补速度增量步骤7.递推测量tk+1时刻的速度完成捷联惯导系统速度更新。本专利技术的第二种实施方式是在第一种实施方式的基础上，步骤1具体包括：光纤陀螺捷联惯导系统初始对准得到初始纵摇姿态角θ0、初始横摇姿态角γ0、初始方位角ψ0。本专利技术的第三种实施方式是在上述任何一种实施方式的基础上，步骤2具体包括：速度解算周期H，速度解算周期循环标志k，即tk到tk+1时间段代表一个速度解算周期H。速度解算周期等于系统采样周期，即H＝h。本专利技术的第四种实施方式是在上述任何一种实施方式的基础上，步骤3具体包括：光纤陀螺捷联惯导系统测量船舶tk时刻姿态信息，所述姿态信息包括tk时刻的纵摇角θk、tk时刻的横摇角γk、tk时刻的艏摇角ψk，再由姿态信息构成tk时刻载体坐标系b与地理坐标系n的关系矩阵本专利技术的第五种实施方式是在上述任何一种实施方式的基础上，步骤4具体包括：tk时刻陀螺输出角速度ωk和tk+1时刻陀螺输出角速度ωk+1利用矢量叉乘法计算得到tk+1时刻旋转坐标系s相对于载体坐标系b运动的旋转角速度αk+1为其中sin-1(·)代表·的反正弦值，|·|代表·的模值，×代表矢量叉乘。本专利技术的第六种实施方式是在上述任何一种实施方式的基础上，步骤5具体包括：利用tk时刻的陀螺输出ωk和加速度计输出fk，步骤3得到的tk时刻载体坐标系b与地理坐标系n的关系矩阵步骤4得到的tk+1时刻旋转坐标系相对于载体坐标系运动的旋转角速度αk+1计算得到tk+1时刻比力积分转换增量本专利技术的第七种实施方式是在上述任何一种实施方式的基础上，步骤6具体包括：利用tk时刻的速度tk时刻的地球自转角速度t本文档来自技高网...

【技术保护点】
1.一种无误差的光纤陀螺捷联惯导系统速度更新方法，其特征是包括如下步骤：步骤1.给定初始导航参数；步骤2、设置采样周期h，实时采集三个轴上陀螺和加速度计的输出信号；步骤3、光纤陀螺捷联惯导系统测量船舶tk时刻姿态信息，所述姿态信息包括tk时刻的纵摇角θk、tk时刻的横摇角γk、tk时刻的艏摇角ψk，再由姿态信息构成tk时刻载体坐标系b与地理坐标系n的关系矩阵；步骤4.递推测量tk+1时刻旋转坐标系相对于载体坐标系运动的旋转角速度αk+1；步骤5.递推测量tk+1时刻比力积分转换增量

【技术特征摘要】
1.一种无误差的光纤陀螺捷联惯导系统速度更新方法，其特征是包括如下步骤：步骤1.给定初始导航参数；步骤2、设置采样周期h，实时采集三个轴上陀螺和加速度计的输出信号；步骤3、光纤陀螺捷联惯导系统测量船舶tk时刻姿态信息，所述姿态信息包括tk时刻的纵摇角θk、tk时刻的横摇角γk、tk时刻的艏摇角ψk，再由姿态信息构成tk时刻载体坐标系b与地理坐标系n的关系矩阵；步骤4.递推测量tk+1时刻旋转坐标系相对于载体坐标系运动的旋转角速度αk+1；步骤5.递推测量tk+1时刻比力积分转换增量步骤6.递推测量tk+1时刻重力/互补速度增量步骤7.递推测量tk+1时刻的速度完成捷联惯导系统速度更新。2.根据权利要求1所述的无误差的光纤陀螺捷联惯导系统速度更新方法，其特征是所述的给定初始导航参数具体为：光纤陀螺捷联惯导系统初始对准得到初始纵摇姿态角θ0、初始横摇姿态角γ0、初始方位角ψ0。3.根据权利要求1所述的无误差的光纤陀螺捷联惯导系统速度更新方法，其特征是所述的设置采样周期h，实时采集三个轴上陀螺和加速度计的输出信号具体包括：速度解算周期H，速度解算周期循环标志k，即tk到tk+1时间段代表一个速度解算周期H，速度解算周期等于系统采样周期，即H＝h；4.根据权利要求1所述的无误差的光纤陀螺捷联惯导系统速度更新方法，其特征是所述的tk时刻载体坐标系b与地理坐标系n的关系矩阵为：5.根据权利要求1所述的无误差的光纤陀螺捷联惯导系统速度更新...

【专利技术属性】
技术研发人员：奔粤阳，高倩倩，赵玉新，周广涛，李倩，吴磊，戴平安，陈海南，
申请(专利权)人：哈尔滨工程大学，
类型：发明
国别省市：黑龙江,23