[发明专利]一种适合车载光纤航姿系统的姿态测量方法

说明书

技术领域

本发明涉及属于惯性导航技术领域，具体涉及一种适合车载光纤航姿系统的姿态测量方法。尤其适用于高动态，对姿态精度要求较高的车载平台。

背景技术

随着车载导航系统在民用领域里应用需求的只益增长，近年来车载组合导航技术得到迅速发展。成本低、精度可靠已经成为用户对民用车载导航系统的基本要求。GPS定姿系统具有成本低、功耗小、体积小、数据长期稳定性好等优点；但是GPS定姿系统也有其自身的缺陷，例如数据更新率低、短期稳定性差，受GPS信号质量制约，在遮挡严重的区域和发生周跳时，姿态计算将会发生错误等。捷联惯导系统(SINS)可以提供连续的载体位置、速度、姿态信息，但是由于陀螺误差随时间不断累积，姿态确定的误差随之增大，在低成本的条件下为了满足姿态确定的精度要求，使用纯惯性导航方案显然是不适用的。

专利号为200710144846.2的《适合于光纤陀螺的载体姿态测量方法》中采用了如下方法：通过外部设备确定载体的初始位置参数与初始速度值；光纤陀螺捷联惯性导航系统进行初始对准，确定载体相对导航坐标系的初始姿态，得到姿态四元数的初始值；确定姿态更新周期；采集光纤陀螺、加速度计输出的载体相对于惯性坐标系的角速度计算旋转矢量的增量；通过旋转矢量与四元数的关系，得到姿态更新周期内姿态更新四元数；由姿态四元数更新方程更新姿态四元数；计算载体坐标系b系相对于导航坐标系n系的捷联矩阵T；求载体相对导航坐标系的姿态角等步骤。

由于原有光纤陀螺的载体姿态各种测量方法往往是以速度、位置作为观测量的，即使有些方法采用GPS速度和姿态信息作为观测量，对各参数的评估精度较高，相对于采用GPS位置和速度信息作为参考信息时，对姿态误差的评估精度有了较大提高，但是，对位置和速度误差的评估精度未有明显改善。引入GPS姿态信息后对惯导姿态误差的评估精度明显较未引入姿态信息时要好，但是对位置、速度的评估效果影响不大，没有明显的改善作用。

发明内容

本发明所要解决的技术问题是提供一种适合车载光纤航姿系统的姿态测量方法，在车载应用平台上，实现高精度的姿态测量，为车载平台提供高精度的姿态信息，从而降低对光纤航姿系统光纤陀螺和加速度计的精度要求。

为解决上述技术问题，本发明的技术方案为：

1、一种适合车载光纤航姿系统的姿态测量方法，采用基于卡尔曼滤波器的低成本光纤航姿系统与GPS组合导航系统，其特征在于，

按照系统解算流程，当GPS输出有效后，利用GPS输出的姿态、速度和SINS输出的姿态、速度之差作为观测量，具体包括如下步骤：

首先建立以SINS误差方程为基础的组合导航系统状态方程，并在误差方程的基础上建立组合系统的量程方程，用一阶线性随机微分方程来描述系统的误差状态传播特性和系统的量测误差状态，方程如下：

X·(t)=F(t)X(t)+G(t)W(t)---(1)]]>

Z(t)＝H(t)X(t)+V(t)……………………………………(2)

选取SINS导航参数计算误差、光纤陀螺仪以及加速度计误差作为系统的状态变量，共12维，即：