CN102589569A

CN102589569A - 一种船用惯性导航系统双点位置数据校准方法

Info

Publication number: CN102589569A
Application number: CN2012100147952A
Authority: CN
Inventors: 汪湛清; 房建成; 汪顺亭
Original assignee: Beijing Institute of Technology BIT
Current assignee: Beijing Institute of Technology BIT
Priority date: 2012-01-17
Filing date: 2012-01-17
Publication date: 2012-07-18

Abstract

本发明涉及惯性导航系统技术领域，为了解决“综合校准”方法中存在的校准数据采集时间长、校准精度不高的问题，本发明出了一种船用惯性导航系统两次单点位置数据校准方法，船舶在码头初始启动后开始远航，船舶在海上航行一段时间，惯性导航系统积累一定导航误差需要校准时，根据本校准方法只需获得外部提供两次单点位置导航数据，即可对系统进行校准，该方法不仅能够缩短校准数据采集的时间，而且还能进一步提高惯性导航系统精度。

Description

一种船用惯性导航系统双点位置数据校准方法

技术领域

本发明涉及惯性导航系统技术领域，具体涉及一种长航时船用惯性导航系统利用海上两次获得的单点位置数据，进行校准提高精度的技术方法。

背景技术

船用惯性导航系统在船舶航行过程中，连续不断地自主计算并输出船舶的各种导航参数，包括船舶的速度、姿态、航向和所在位置的经度、纬度等数据。惯性导航系统这种不需要借助电磁波或光波与外部卫星或天体联系，而独立实现的导航功能的自主性是它的优点，但是惯性导航系统的误差，特别是它提供的位置经度和纬度的误差，随船舶航行时间的延长而不断增长累积。远洋船舶在海上航行时间很长，船用惯性导航系统需在海上连续工作数十天甚至数月，不断增长的位置经度和纬度误差就必然会超出允许的范围。因此船用惯性导航系统工作一段时间后，在有可能获得外部提供的准确导航数据时，为恢复和保证惯性导航系统的导航精度，需借助外部数据对惯性导航系统累计的误差进行校准。

通常采用“综合校准”方法恢复惯性导航系统原有精度，这种“综合校准”方法相当于在惯性导航系统不断电情况下，进行一次与码头系泊状态下初始启动类似的重新启动过程。“综合校准”需花费与初始启动时相同的长达5小时的时间，在这段时间内需要连续获得外部(如卫星导航)的信息。此外，这种类似带电重新启动的“综合校准”方法，与在码头系泊状态启动的工作机理相同，但是由于海上风浪较大，惯性导航系统的工作条件比码头系泊状态恶劣，综合校准后惯性导航系统的工作精度，最好情况下也只是接近码头系泊状态初始启动后的精度。

由此可见，通常采用的“综合校准”方法的工作机理，与码头系泊状态下进行的初始启动工作机理相类似。海上“综合校准”后，惯性导航系统精度通常会比码头初始启动后稍差，最好情况下也只能接近原有精度。此外还需要持续5小时有外部提供导航数据，这是“综合校准”方法缺陷。

发明内容

为了解决“综合校准”方法中存在的校准数据采集时间长、校准精度不高的问题，本发明提出了一种船用惯性导航系统双点位置数据校准方法，船舶在码头初始启动后开始远航，船舶在海上航行一段时间，惯性导航系统积累一定导航误差需要校准时，根据本校准方法只需获得外部提供两次单点位置导航数据，即可对系统进行校准，该方法不仅能够缩短校准数据采集的时间，而且还能进一步提高惯性导航系统精度。

一种船用惯性导航系统双点位置数据校准方法，适用于船舶未装载天文导航设备，不能提供外部准确的航向信息的情况，该方法实现的具体过程如下：

步骤一：船舶航行一段时间t₁，根据船舶上的惯性导航系统输出的位置数据以及卫星导航接收机提供的导航数据，得到：

δλ(t₁)＝λ′(t₁)-λ(t₁) (1)

δL(t₁)＝L′(t₁)-L(t₁) (2)

其中，λ(t₁)表示t_x1时刻卫星导航接收机提供的单点位置经度，λ′(t₁)表示t_x1时刻惯性导航系统输出的位置经度，δλ(t₁)表示t_x1时刻惯性导航系统累计的位置经度误差；L(t₁)表示t_x1时刻卫星导航接收机提供的单点位置纬度，L′(t₁)表示t_x1时刻惯性导航系统输出的位置纬度，δL(t₁)表示t_x1时刻惯性导航系统累计的位置纬度误差；

步骤二：船舶航行一段时间t₂，根据船舶上的惯性导航系统输出的位置数据以及卫星导航接收机提供的导航数据，得到：

δλ(t₂)＝λ′(t₂)-λ(t₂) (3)

δL(t₂)＝L′(t₂)-L(t₂) (4)

其中，船舶航行时间t₂包含t₁；λ(t₂)表示t_x2时刻卫星导航接收机提供的单点位置经度，λ′(t₂)表示t_x2时刻惯性导航系统输出的位置经度，δλ(t₂)表示t_x2时刻惯性导航系统累计的位置经度误差；L(t₂)表示t_x2时刻卫星导航接收机提供的单点位置纬度，L′(t₂)表示t_x2时刻惯性导航系统输出的位置纬度，δL(t₂)表示t_x2时刻惯性导航系统累计的位置纬度误差；

步骤三：根据惯性导航系统累计的位置误差δλ(t₁)、δL(t₁)、δλ(t₂)、δL(t₂)以及公式(5)和(6)，得到惯性导航系统误差源陀螺漂移(ε_x，ε_y，ε_z)的公式(7)：

[\begin{matrix} δλ (t_{1}) \\ δL (t_{1}) \end{matrix}] = [\begin{matrix} \frac{tgL}{Ω} (1 - \cos Ω t_{1}) & - (\frac{tg}{Ω} \sin L \sin Ω t_{1} + \cos L t_{1}) & \frac{\sin L}{Ω} \sin Ω t_{1} - \sin L t_{1} \\ \frac{1 - \cos {Ωt}_{1}}{Ω \cos L} & - \frac{tgL}{Ω} & \frac{\sin Ω t_{1}}{Ω} \end{matrix}] [\begin{matrix} ϵ_{X} \\ ϵ_{Y} \\ ϵ_{Z} \end{matrix}] - - - (5)

[\begin{matrix} δλ (t_{2}) \\ δL (t_{2}) \end{matrix}] = [\begin{matrix} \frac{tgL}{Ω} (1 - \cos Ω t_{2}) & - (\frac{tg}{Ω} \sin L \sin Ω t_{2} + \cos L t_{2}) & \frac{\sin L}{Ω} \sin Ω t_{2} - \sin L t_{2} \\ \frac{1 - \cos {Ωt}_{2}}{Ω \cos L} & - \frac{tgL}{Ω} & \frac{\sin Ω t_{2}}{Ω} \end{matrix}] [\begin{matrix} ϵ_{X} \\ ϵ_{Y} \\ ϵ_{Z} \end{matrix}] - - - (6)

[\begin{matrix} ϵ_{X} \\ ϵ_{Y} \\ ϵ_{Z} \end{matrix}] = {[\begin{matrix} \frac{tgL}{Ω} (1 - \cos {Ωt}_{1}) & - (\frac{tgL}{Ω} \sin L \sin Ω t_{1} + \cos L t_{1}) & \frac{\sin L}{Ω} \sin Ω t_{1} - \sin L t_{1} \\ \frac{\sin Ω t_{1}}{Ω} & \frac{\sin L}{Ω} (1 - \cos Ω t_{1}) & - \frac{\cos L}{Ω} (1 - \cos Ω t_{1}) \\ \frac{tgL}{Ω} (1 - \cos Ω t_{2}) & - (\frac{tgL}{Ω} \sin L \sin Ω t_{2} + \cos L t_{2}) & \frac{\sin L}{Ω} \sin Ω t_{2} - \sin L t_{2} \end{matrix}]}^{- 1} [\begin{matrix} δλ (t_{1}) \\ δL (t_{1}) \\ δλ (t_{2}) \end{matrix}] - - - (7)

其中，Ω表示地球自转角速率，L表示纬度；

步骤四：采用惯性导航系统误差源陀螺漂移(ε_x，ε_y，ε_z)，对惯性导航系统进行补偿，由此实现对惯性导航系统的一次校准。

有益效果

(1)由本发明提供的公式(7)可见，为计算惯性导航系统误差源陀螺漂移，只需获得外部两次单点位置数据即可计算得出陀螺漂移，不需要像通常采用的“综合校准”方法那样，持续5小时连续不断获得外部提供导航数据，本方法缩短了获取外部提供导航数据时间，易于实施方便实用。

(2)本发明提供的两次单点位置数据校准方法，揭示了船用惯性导航系统误差增长机理。根据外部导航数据λ(t₁)、L(t₁)、λ(t₂)、L(t₂)和惯性导航系统输出的含有误差的导航数据λ′(t₁)、L′(t₁)、λ′(t₂)、L′(t₂)计算得出的惯性导航系统导航数据误差量δλ(t₁)、δL(t₁)、δλ(t₂)、δL(t₂)，可计算出使惯性导航系统产生误差的误差源陀螺漂移(ε_x，ε_y，ε_z)，利用计算得出的陀螺漂移，对惯性导航系统进行修正补偿从而可进一步提高惯性导航系统精度。

附图说明

图1为两次单点位置数据校准方法实施流程图；

图2为惯性导航系统与外部导航数据关系示意图。

具体实施方式

下面结合附图对本发明进行详细描述。

本发明提供了一种船用惯性导航系统双点位置数据校准方法，该方法采用的数据源于船舶装备的惯性导航系统与船舶卫星导航接收机，而船舶装备的惯性导航系统与船舶卫星导航接收机有信息接口，卫星天线获得的船舶位置经度和纬度数据可直接进入惯性导航计算机，船舶装备的惯性导航系统与船舶卫星导航接收机的关系示意图如图2所示。

基于上述基础，本实施例中模拟船舶航行过程中的惯性系统误差补偿。船舶在码头系泊状态下进行初始启动，如图1所示，其中初始启动时间为t_c，为5小时，此时码头当地位置经度和纬度数据已知，速度为零。初始启动后离开码头开始航行，导航计算机开始计算时间t，航行数小时后惯性导航系统的导航数据积累一定误差，准备校准时，按下导航计算机操控按键，导航计算机根据机器中的算法软件自动运行校准程序，导航计算机高速运行，自动校准可在一个采样步长(0.1秒)内完成。其中，自动校准采用的方法如下：

惯性导航系统航行工作时间长度为t₁时，导航计算机记录t_x1时刻卫星导航接收机提供的导航数据λ(t₁)、L(t₁)和惯性导航系统输出的位置数据λ′(t₁)、L′(t₁)。3小时后，即惯性导航系统在t₁的基础上继续工作3小时，当其航行工作时间长度为t₁+3小时时，即工作时间为t₂时，导航计算机记录t_x2时刻卫星导航接收机提供的导航数据λ(t₂)、L(t₂)和惯性导航系统输出的导航数据λ′(t₂)、L′(t₂)。

根据卫星导航接收机和惯性导航系统两次记录的数据，利用公式(1)、(2)、(3)和(4)计算惯性导航系统的导航数据误差δλ(t₁)、δL(t₁)、δλ(t₂)、δL(t₂)。根据惯性导航系统导航系数据误差利用公式(7)计算惯性导航系统误差源陀螺漂移(ε_x，ε_y，ε_z)。

利用计算得出的惯性导航系统误差源陀螺漂移(ε_x，ε_y，ε_z)，对惯性导航系统进行修正补偿，进一步提高惯性导航系统精度。

Claims

1.一种船用惯性导航系统双点位置数据校准方法，其特征在于：适用于船舶未装载天文导航设备，不能提供外部准确的航向信息的情况，该方法实现的具体过程如下：

δλ(t₁)＝λ′(t₁)-λ(t₁) (1)

δL(t₁)＝L′(t₁)-L(t₁) (2)

δλ(t₂)＝λ′(t₂)-λ(t₂) (3)

δL(t₂)＝L′(t₂)-L(t₂) (4)

[\begin{matrix} δλ (t_{1}) \\ δL (t_{1}) \end{matrix}] = [\begin{matrix} \frac{tgL}{Ω} (1 - \cos Ω t_{1}) & - (\frac{tg}{Ω} \sin L \sin Ω t_{1} + \cos L t_{1}) & \frac{\sin L}{Ω} \sin Ω t_{1} - \sin L t_{1} \\ \frac{1 - \cos {Ωt}_{1}}{Ω \cos L} & - \frac{tgL}{Ω} & \frac{\sin Ω t_{1}}{Ω} \end{matrix}] [\begin{matrix} ϵ_{X} \\ ϵ_{Y} \\ ϵ_{Z} \end{matrix}] - - - (5)

[\begin{matrix} δλ (t_{2}) \\ δL (t_{2}) \end{matrix}] = [\begin{matrix} \frac{tgL}{Ω} (1 - \cos Ω t_{2}) & - (\frac{tg}{Ω} \sin L \sin Ω t_{2} + \cos L t_{2}) & \frac{\sin L}{Ω} \sin Ω t_{2} - \sin L t_{2} \\ \frac{1 - \cos {Ωt}_{2}}{Ω \cos L} & - \frac{tgL}{Ω} & \frac{\sin Ω t_{2}}{Ω} \end{matrix}] [\begin{matrix} ϵ_{X} \\ ϵ_{Y} \\ ϵ_{Z} \end{matrix}] - - - (6)

[\begin{matrix} ϵ_{X} \\ ϵ_{Y} \\ ϵ_{Z} \end{matrix}] = {[\begin{matrix} \frac{tgL}{Ω} (1 - \cos Ω t_{1}) & - (\frac{tgL}{Ω} \sin L \sin Ω t_{1} + \cos L t_{1}) & \frac{\sin L}{Ω} \sin Ω t_{1} - \sin L t_{1} \\ \frac{\sin Ω t_{1}}{Ω} & \frac{\sin L}{Ω} (1 - \cos Ω t_{1}) & - \frac{\cos L}{Ω} (1 - \cos Ω t_{1}) \\ \frac{tgL}{Ω} (1 - \cos Ω t_{2}) & - (\frac{tgL}{Ω} \sin L \sin Ω t_{2} + \cos L t_{2}) & \frac{\sin L}{Ω} \sin Ω t_{2} - \sin L t_{2} \end{matrix}]}^{- 1} [\begin{matrix} δλ (t_{1}) \\ δL (t_{1}) \\ δλ (t_{2}) \end{matrix}] - - - (7)

其中，Ω表示地球自转角速率，L表示纬度；

2.如权利要求1所述的一种船用惯性导航系统双点位置数据校准方法，其特征在于：t₂与t₁的时间差不小于3小时。