[发明专利]一种船用激光陀螺惯性导航系统位置校正方法

说明书

技术领域

本发明涉及一种新型、高效、实用的船用激光陀螺惯性导航系统位置校正方法，可应用于其它类型的水面/水下运载体的惯性导航系统中，属于惯性导航领域。

技术背景

惯性导航系统具有全自主、高隐蔽性、高带宽、连续输出等特点，在国防上具有战略意义，是航空、航天、航海等领域中最重要的设备之一。

船用应用环境中，常要求惯导系统连续工作几天甚至更长时间，由于陀螺漂移等原因会使惯导系统逐渐失去导航功能。提高惯导系统长时间导航精度可采取两方面措施：(1)提高惯性器件精度，然而提高惯性器件精度往往需要付出较大的代价，成本也将大大提高；(2)采取适当的系统级算法，在有外部参考信息时对系统进行校正(可用外部参考信息一般为位置和速度)，将惯导误差限制在一定的范围之内。传统的位置校正算法有两种类型：一种是在有参考信息时只校正位置和速度，这种方法只需一次有效的外部参考信息即可实现，因此简单方便，然而却不能抑制惯导误差的舒拉振荡(导航误差的一种周期性振荡)，也不能从根本上解决陀螺漂移带来的惯导误差发散问题；另一种方案基于陀螺漂移为常值的假设，利用惯导误差模型拟合出平台偏角和陀螺漂移，并修正位置和速度。然而陀螺漂移在长时间导航时不会保持常值，而是在不断地发生变化，因此拟合出的平台偏角有较大误差。

发明内容

本发明的技术解决问题是：克服现有船用惯导系统位置校正算法在处理变化的陀螺漂移等问题上的弊端，能更准确地拟合出舒拉振荡的参数以及导致导航误差发散的地轴方向陀螺漂移，具有准确、高效、实用、易于实现等特点。

本发明的技术解决方案是：一种船用激光陀螺惯性导航系统位置校正方法，其实现步骤如下：

(1)将长时间导航时完整惯导误差模型在校正时间内进行简化，得到短时间内简化惯导误差模型；

(2)根据步骤(1)所建立的短时间内惯导误差模型短时间内简化惯导误差模型，利用三次间断获得的外部位置、速度参考信息，得到当前时刻惯导系统的位置误差、速度误差，并计算出惯导系统的数学平台偏角；

(3)在完整惯导误差模型中，将位置误差、速度误差和数学平台偏角造成的影响扣除，并忽略陀螺漂移造成的舒拉振荡项，得到无舒拉振荡条件下由陀螺漂移造成的惯导系统误差方程；

(4)将步骤(2)计算出数学平台偏角的影响从三次获得的外部位置、速度参考信息中扣除，得到由等效陀螺漂移引起的惯导系统误差；

(5)根据步骤(3)所建立的无舒拉振荡条件下由陀螺漂移造成的惯导系统误差方程及步骤(4)得到由等效陀螺漂移引起的惯导系统误差，若获得外部参考信息时刻为24h整倍数时，则计算导致惯导误差发散的等效地轴方向陀螺漂移；

(6)根据步骤(2)及(5)估计得到的惯导系统速度误差、位置误差、平台偏角误差及陀螺漂移对系统进行修正，提高导航精度。

本发明的原理是：通过运载体在1h内间隔3次获取外部参考位置、速度信息，结合惯导系统短时间误差模型，可以拟合出当前时刻惯导系统舒拉振荡系数，若校正时刻发生在24h整倍数附近，则可根据误差模型计算导致系统导航误差发散的等效地轴方向漂移。

本发明与现有技术相比的优点在于：

(1)传统的位置校正算法基于陀螺漂移为常值的假设，然而陀螺漂移在长时间导航时不会保持常值，而是在不断地发生变化，因此传统的位置校正算法拟合出的平台偏角和陀螺漂移有较大误差。本发明建立了校正时刻一段时间内惯导的误差模型，避免了整个过程漂移变化带来的影响，提高了误差系数的估计精度。

(2)本发明在修正陀螺漂移时，只针对导致导航误差发散的地轴方向陀螺漂移进行，具有准确、高效、实用、易于实现等特点。

附图说明

图1为本发明所指的惯性导航系统位置校正方法流程图；

图2为本发明实施例中不含位置校正时的位置误差曲线；

图3为本发明实施例中不含位置校正时的速度误差曲线；

图4为本发明实施例中不含位置校正时的姿态误差曲线；

图5为本发明实施例中进行位置校正时的位置误差曲线；

图6为本发明实施例中进行位置校正时的速度误差曲线；

图7为本发明实施例中进行位置校正时的姿态误差曲线。

具体实施方式

下面以某型激光陀螺惯导系统海上试验位置校正过程为例来阐述本发明的具体实施过程。

1、将长时间导航时完整惯导误差模型在校正时间内进行简化，得到短时间内简化惯导误差模型如下：