一种导航终端的制作方法

本申请涉及导航技术领域，特别涉及一种导航终端。

背景技术：

捷联式惯性导航系统(SINS)直接利用安装在载体上的惯性测量单元(IMU)测量出载体沿三个轴的加速度和角速率，经过变换和积分等运算得到载体的姿态、速度、位置等信息。微型捷联惯导系统(MSINS)在体积、功耗、耐冲击等方面的优点使惯性系统的应用领域更加宽广，纯惯导系统的优点是不依赖于任何外界信息就能够实现完全自主的导航，抗干扰能力强，隐蔽性、实时性好。但目前SINS的精度比较低，导致惯导系统误差随着时间积累而增大，因此，单独使用SINS来实现较高精度的载体制导任务就难以胜任。为此，需要利用其它定位手段作为参考信息源，定期对SINS进行校正和对漂移进行补偿。

全球卫星导航系统(GNSS)可为全球范围提供全天候、连续、精密的三维定位和导航服务，已广泛应用于航空、航天、航海及地面运载工具的导航和定位。例如北斗卫星导航系统是中国正在实施的自主发展、独立运行的全球卫星导航系统，是独立自主、开放兼容、技术先进、稳定可靠的卫星导航系统，其突出优点是其导航定位精度高，并且导航定位精度基本不受时间和地域的限制。目前，当卫星信号受到遮挡或干扰时，其优势就不能发挥出来，在需要获得载体连续的位置、速度、姿态等控制信息时，也不能满足其性能要求。因此目前GNSS还只能作为一种辅助导航设备，而不能作为唯一的导航设备使用。

因此，如何将卫星导航和惯性导航有机结合，获得优于任何单一导航系统的导航精度和可靠性，是本领域技术人员需要解决的技术问题。

技术实现要素：

本申请的目的是提供一种导航终端，将卫星导航装置和惯性导航装置有机结合，获得优于任何单一导航终端的导航精度和可靠性。

为解决上述技术问题，本申请提供一种导航终端，包括：

卫星导航装置，用于获取卫星导航信号且经过PVT解算得到卫星导航预处理数据，并将卫星导航预处理数据发送给处理器；

惯性导航装置，用于获取惯性导航的原始惯性测量数据且经过捷联惯性导航算法解算得到惯性导航解算结果，并将所述原始惯性测量数据以及所述惯性导航解算结果发送给所述处理器；

外部观测部件，用于获取外部观测信息，并发送给所述处理器；其中，所述外部观测信息包括温度和启动时间；

存储芯片，用于存储程序；

与所述卫星导航装置、所述惯性导航装置、所述外部观测部件以及所述存储芯片均相连的处理器，用于执行所述存储芯片中的程序，以利用所述外部观测信息以及所述原始惯性测量数据计算误差数据，并对所述卫星导航预处理数据、所述惯性导航解算结果以及所述误差数据进行组合导航滤波，输出滤波结果。

可选的，所述外部观测部件包括：温度传感器和计时器。

可选的，所述卫星导航装置具体为北斗卫星导航装置。

可选的，所述惯性导航装置具体为捷联式惯性导航装置。

可选的，所述存储芯片具体为EEPROM。

可选的，该导航终端还包括：

与所述处理器相连的低压差稳压源，用于为所述导航终端提供稳定的输入电源。

可选的，该导航终端还包括：

与所述处理器相连的I²C硬件接口，用于输出所述滤波结果。

可选的，该导航终端还包括：

与所述I²C硬件接口相连的显示器，用于显示所述滤波结果。

本申请所提供的一种导航终端，该导航终端包括：卫星导航装置，惯性导航装置，外部观测部件，存储芯片，以及与卫星导航装置、惯性导航装置、外部观测部件以及存储芯片均相连的处理器；其中，处理器输出组合导航滤波的滤波结果；该导航终端能够将卫星导航装置和惯性导航装置有机结合，获得优于任何单一导航终端的导航精度和可靠性。

附图说明

为了更清楚地说明本申请实施例或现有技术中的技术方案，下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍，显而易见地，下面描述中的附图仅仅是本申请的实施例，对于本领域普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据提供的附图获得其他的附图。

图1为申请实施例所提供的导航终端的结构框图；

图2为申请实施例所提供的另一导航终端的结构框图。

具体实施方式

本申请的核心是提供一种导航终端，将卫星导航装置和惯性导航装置有机结合，获得优于任何单一导航终端的导航精度和可靠性。

为使本申请实施例的目的、技术方案和优点更加清楚，下面将结合本申请实施例中的附图，对本申请实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例是本申请一部分实施例，而不是全部的实施例。基于本申请中的实施例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例，都属于本申请保护的范围。

请参考图1，图1为申请实施例所提供的导航终端的结构框图；该导航终端可以包括：

卫星导航装置100，用于获取卫星导航信号且经过PVT解算得到卫星导航预处理数据，并将卫星导航预处理数据发送给处理器；具体的，卫星导航装置具体为北斗卫星导航装置。

具体的，本实施例也不限定具体的PVT解算过程。下面提供一种具体的针对北斗卫星导航的特点的PVT解算过程：即利用下面公式1进行。

利用公式Q＝PQ+DM+KF+Sn+F+J+Sa+C+RD+Hdop+Cn0进行PVT解算；

其中，Q为组合算法估计出的定位质量系数，PQ为定位质量，DM为定位模式，KF为解算模式质量因子，Sn为参与解算的卫星数，F为错误模式，J为判停模式，C为载体速度，Sa为方位角，Hdop为水平定位精度，Cn0为灵敏度质量因子，RD为载体坐标系上四元数表示的投影分量。上述的各个参数都可以从标准的PVT解算结果中获取。

由于北斗卫星导航信号的PVT解算的质量对导航系统误差影响很大，本实施中针对北斗卫星导航的特点设计了PVT解算质量估计模型(公式1)，通过模型可以有效的提高PVT解算的数据质量，提高组合导航的精度。经过公式1得到的定位质量系数将作为组合导航滤波时的量测误差量之一。

惯性导航装置200，用于获取惯性导航的原始惯性测量数据且经过捷联惯性导航算法解算得到惯性导航解算结果，并将原始惯性测量数据以及惯性导航解算结果发送给处理器；具体的，惯性导航装置具体为捷联式惯性导航装置。

具体的，惯性导航装置200除了用于采用捷联惯性导航算法进行解算还可以包括测量部件；测量部件可以但不限于包括三轴陀螺仪、三轴加速度计、三轴磁力计。相应的，原始惯性测量数据包括：陀螺仪原始测量数据、加速度计原始测量数据、磁力计原始测量数据。

本实施例中利用捷联惯性导航算法对原始惯性测量数据进行解算可以包括：根据原始惯性测量数据，计算解算点的地球曲率半径，并进行速度解算、位置解算以及姿态解算。

具体的，利用公式计算解算点的地球曲率半径；

其中，a为地球长半轴半径，e为地球扁率，lat为捷联导航解算点的纬度。

进行速度解算，计算旋转矢量的变化值，即经度、纬度、高度的变化量测值，并转化为导航坐标系到载体坐标系上四元数表示的投影分量值。通过对投影分量值的时间历元处理转化为旋转矢量上投影分量，最后利用上一次迭代的速度和当前观测加速度的积分值，求出当前时刻的导航坐标系统的速度分量，主要解算公式如下：

Rd＝Vn×0.5×Dt/(Rm+Dr)

V1＝Vn+0.5×Dv

其中，Rd为载体坐标系上四元数表示的投影分量，Vn为当前坐标系下的速度分量，V1为迭代后的三轴速度分量，Dt是时间历元，Dv为导航系下的速度向量，Dr为地理坐标系下的位置向量，Rm为地球子午线对应的曲率半径。

进行位置解算，主要解算公式如下：

Wen＝Vn×k(Mv+Rn×Dv)

R＝R1–Dt×Dv

其中，Wen为导航系下的转换速率，Vn为当前坐标系下的速度分量，Rn为卯酉圈的曲率半径，Mv为差值速度向量，k为转换系数，可以根据经验值或实验值确定；R1为上一解算时刻的位置矢量，R为解算后的位置矢量。

采用等效转动矢量法辅助姿态算法，进行姿态解算，姿态解算公式以及等效转动矢量最终结果公式如下所示：

其中，为转动矢量矩阵，ψ为载体的航向角，θ均为俯仰角，γ为横滚角，φ为等效转动矢量，ω角速度矢量，i为算法的i阶，j为算法的j阶，m为姿态个数，N为算法的阶数，kij为算法系数。

等效转动矢量的迭代计算采用较高的频率，而用了等效转动矢量后的方向余弦矩阵计算则用较低迭代频率，两种方式的结合构成了捷联矩阵的计算。

外部观测部件300，用于获取外部观测信息，并发送给处理器；其中，外部观测信息包括温度和启动时间。

具体的，外部观测部件300可以但不限于包括：温度传感器，用于提供计算误差数据所需的温度。时间可以通过计时器或者仪表盘获得。其它外部观测数据也可以直接从相应仪器或设备中读取，或预先输入/保存在外部观测部件300中。

存储芯片400，用于存储程序；具体的，存储芯片400可以但不限于为EEPROM。

处理器500，用于与卫星导航装置、惯性导航装置、外部观测部件以及存储芯片均相连的处理器，用于执行存储芯片中的程序，以利用外部观测信息以及原始惯性测量数据计算误差数据，并对卫星导航预处理数据、惯性导航解算结果以及误差数据进行组合导航滤波，输出滤波结果。

具体的，根据陀螺仪和加速度计各轴对应的原始测量数据，对原始测量数据进行数据误差补偿(即分别对陀螺仪和加速度计各轴的原始测量数据进行数据误差补偿)；分别计算陀螺仪和加速度计各轴的位置误差；计算陀螺仪的稳定零偏误差、姿态误差角以及速度误差。

具体的，位置误差C1具体可以是：C1＝(Z–B)/(1+S)；

其中，Z为所计算的轴的原始观测数据，B为所计算的轴的标定偏置误差，S为所计算的轴的刻度因子误差，其中，B和S可以根据经验值或仪器厂商提供的参数得到。

稳定零偏误差可以利用公式W稳定零偏＝a0+a1t+a2T+a3T²+a4T³+a5ΔT计算；

其中，t为陀螺仪的启动时间，T为陀螺仪的内部温度，ΔT为温度变化梯度，a0为常数项，a1～a5为系数；具体的，ΔT、a0、a1～a5可以根据经验或仿真值设定。

本实施中在导航开始后，评估高频IMU原始测量数据的零偏误差、刻度因子误差，角度随机游走系数，并据此补偿高频IMU原始测量数据，可提高原始测量数据输出的精度。MEMS(Micro Electro Mechanical systems，微电子机械系统)陀螺仪的零偏误差同时受到多个变量因素影响，温度是其影响因素之一，本实施方式针对MEMS陀螺仪特点，设计了MEMS陀螺的温度区间零偏计算模型，可以据此进行零偏补偿。

计算由于圆锥运动导致等效陀螺仪等输出漂移，本实施方式采用圆锥补偿算法来消除圆锥误差的影响，从而提高姿态计算的精度；计算姿态误差角C2为：C2＝A1×B1–B2×A2。

其中，A1为解算前上一个采样点陀螺仪的原始观测数据，B1为解算前上一个采样点的加速度计的原始观测数据，A2为解算时当前采样点陀螺仪的观测数据，B2为解算时当前采样点的加速度计的观测数据。

计算由于Sculling Motion(划船运动)导致等效陀螺仪等输出漂移，对划船效应误差进行补偿，这样能有效提高速度更新中比力的转换精度，减少了速度误差；计算速度误差C3为：C3＝1/2×(A2×B2+B1×A1+B1×A2)/12.0；

其中，A1为解算前上一个采样点陀螺仪的原始观测数据，B1为解算前上一个采样点的加速度计的原始观测数据，A2为解算时当前采样点陀螺仪的观测数据，B2为解算时当前采样点的加速度计的观测数据。

进一步本实施方式中，零偏补偿、数据误差补偿、圆锥误差补偿及划船效应补偿(即数据误差补偿、位置误差、稳定零偏误差、姿态误差角以及速度误差)的先后顺序可以不限，也可以按照预定顺序进行。

可选的利用卡尔曼滤波器进行滤波。具体过程可以是：

根据误差数据建立卡尔曼滤波器的状态方程；其中，状态方程中的状态量包括位置误差、速度误差、稳定零偏误差、姿态误差角以及陀螺仪角度随机游走系数；

其中，根据上述步骤计算的到的位置误差、速度误差、姿态误差角、以及陀螺仪角度随机游走系数和零偏作为状态量。对应的建立的卡尔曼滤波器的状态方程(状态向量)如下：

其中，X为状态向量，表示东、北、天方向的姿态误差角，δVe、δVn、δVu和δL、δλ、δh分别表示东、北、天方向的速度误差和纬度、经度、高度的位置误差，εx、εy、εz表示沿载体系xyz轴上的角度随机游走系数，▽x、▽y、▽z表示沿载体系xyz轴上的陀螺仪零偏。

根据状态方程，建立误差协方差矩阵，并构建系统噪声矩阵；

具体的，根据上述卡尔曼滤波状态方程，建立误差协方差矩阵A(t)，A(t)为15×15维的矩阵；A(t)表示为如下形式：

其中，0表示零矩阵，下标表示该零矩阵是几乘几的矩阵。

根据北斗卫星导航预处理数据、解算结果、状态方程、误差协方差矩阵以及系统噪声矩阵建立量测方程进行组合导航卡尔曼滤波。

其中，F11、F12、F13、F14、F21、F22、F23、F24、F32、F33、F43分别为：

其中，L为纬度，h为高度，Vn为导航坐标系下的速度分量；Rn为卯酉面曲率半径，Rm为子午面曲率半径，Ve为地球坐标系下的速度矢量，ωie为地球自转角速率。

其中，α为速度分量方差，β为位置分量方差。

其中，fu、fn、fe为分别为地理坐标系下天向、北向、东向方向上的比力。

其中，为转动矢量矩阵。

进一步的构建系统噪声矩阵R，对于北斗(BD)量测卡尔曼更新，R是MN×MN维的矩阵，其表示形式速度和位置标准差的对角阵，如下：

其中，X为状态向量；M为代表速度和位置标准差的6维向量，N为算法的阶数；H为转置共轭。

根据所述卫星导航(如北斗卫星导航)预处理数据及所述解算结果，以及所述状态方程建立量测方程。以北斗卫星导航和SINS捷联惯性导航为例，该过程具体为：取北斗PVT解算位置信息与SINS捷联解算位置信息的差值以及北斗PVT解算速度信息与SINS捷联解算的速度信息的差值作为观测量值，量测方程公式如下：

Z(t)＝H(t)X(t)+w(t)

其中，X(t)为上述求得的状态向量，w(t)为系统过程白噪声，H(t)为观测矩阵。

H(t)为观测矩阵定义如下：

建立非完整性约束组合导航滤波方程，加入载体约束条件，在不增加硬件的基础上提高导航精度、重新建立量测方程，选取两轴上的速度直接误差作为外部观测量Z1；其中，为载体系上迭代计算后的x轴与z轴的速度误差。

根据速度坐标转换得到量测方程如下：

其中，量测噪声γn是零均值的白噪声，量测矩阵H1为：

其中，Vⁿ为导航坐标系下的速度矢量，V^e为地球坐标系下的速度矢量，后括号中的数字是指在矩阵中相应行和列上的元素，比如就是指中第1行第2列的元素；其它可以类推。

最后可以根据组合导航卡尔曼滤波的结果反馈给SINS系统做位置、速度、姿态信息的修正。

进一步还可以同步输出卫星导航、组合导航两种解算结果，两种导航结果通过组合滤波后能够相互辅助，在北斗信号失锁后，能继续提供全姿态的导航数据，最终提高全天候的导航结果的精度和可靠性。

基于上述技术方案，本申请实施例提供的导航终端能够将卫星导航装置和惯性导航装置有机结合，获得优于任何单一导航终端的导航精度和可靠性。

请参考图2，基于上述实施例，该导航终端还可以包括：

低压差稳压源600，用于与处理器500相连，为导航终端提供稳定的输入电源。

具体的，低压差稳压源600，提供稳定输入的电源；放置位置应远离惯测量性器件和磁强计以最大程度上减小热量散发对器件造成零偏影响。

请参考图2，基于上述任意实施例，该导航终端还可以包括：

I²C硬件接口700，用于与处理器500相连，输出滤波结果。

具体的，数据I/O(输入/输出)接口，采用高速I²C硬件接口，用于实时输出滤波结果给外部观测部件；还可以另外输出卫星导航预处理数据、解算结果等此时需要与对应的惯性导航装置和卫星导航装置相连。

请参考图2，基于上述实施例，该导航终端还可以包括：

显示器800，用于与所述I²C硬件接口700相连，显示所述滤波结果。

通过显示器800可以形象的将滤波结果展示给用户，以提高用户体验。

基于上述任意实施例，处理器500还用于将滤波结果反馈给惯性导航系统进行位置、速度以及姿态信息的修正。可以将组合导航滤波的结果反馈给惯性导航系统做位置、速度、姿态信息的修正。以提高导航准确度。

以上对本申请所提供的导航终端进行了详细介绍。本文中应用了具体个例对本申请的原理及实施方式进行了阐述，以上实施例的说明只是用于帮助理解本申请的方法及其核心思想。应当指出，对于本技术领域的普通技术人员来说，在不脱离本申请原理的前提下，还可以对本申请进行若干改进和修饰，这些改进和修饰也落入本申请权利要求的保护范围内。