一种分析惯性导航系统可观测性的方法技术方案

本发明专利技术提供一种分析惯性导航系统可观测性的方法，具体过程为：步骤一，建立惯性导航系统的系统模型，所述系统模型包括误差模型和观测方程；步骤二，对系统模型进行离散化处理，利用离散化后的系统模型构建可观测矩阵；步骤三，通过对可观测矩阵进行变换和求解，计算出系统全部状态的可观测度；步骤四，根据所述可观测度，分析出系统每一个状态的可观测性，进一步可以反应出该状态的Kalman滤波结果是否准确。该方法着重考虑的是每一个状态的可观测度，单一状态的可观测度能够比整个系统的可观测度更加准确而详细的描述系统的可观测性，并且解决了以往的可观测度分析方法无法求解单一状态的可观测度的问题。

【技术实现步骤摘要】

本专利技术涉及一种分析惯性导航系统可观测性的方法，适用于求解各类惯性导航系统的可观测度，属于惯性导航系统可观测分析

技术介绍
惯性导航系统是复杂的高精度机电综合系统，由于具有完全自主性的优点而广泛应用于陆海空天领域。但是在惯性导航系统中，各种误差状态的存在(如三向误差角，陀螺仪零偏，加速度计零偏等)会导致惯性导航系统的导航定位精度下降。所以在实际应用中，将惯性导航系统中的各种误差状态估计出来并对惯性导航系统进行反馈补偿是很有必要的，其可以在不增加硬件成本的基础上显著提高导航定位精度。但是由于惯性导航系统是一个线性时变系统，同时系统结构复杂，系统状态众多，很多影响导航定位精度的误差状态并不是直接可观测而是隐含在系统的观测量中。在实际应用中，一般采用Kalman滤波来完成对这些隐含的系统误差状态的估计。在满足Kalman滤波各项假设的前提下，Kalman滤波结果是最优的，可以准确地完成对状态的估计。但是Kalman滤波也有其局限性，其只能对可观测的系统状态做出很好的估计，而对于不可观测的系统状态，滤波结果一般较差甚至发散。所以，在惯性导航系统中应用Kalman滤波而对误差状态进行估计时，对系统进行可观测度分析是十分有必要的。首先，根据可观测度分析的结果，可以判断出在系统当前运行状态下哪些误差状态是可观测的，进一步可以利用 Kalman滤波准确地估计出这些可观测的误差状态。其次，对于那些可观测度为零的误差状态，说明在系统当前运行状态下它们是不可观测的，即不能通过Kalman滤波来获得准确的滤波结果，但是考虑到惯性导航系统是一个线性时变系统，即系统的运行状态会对惯性导航系统模型产生影响进而对状态的可观测度产生影响，所以可以通过调整系统的运行状态而影响状态的可观测度，使得不可观测的误差状态变成可观测的。此时便需要利用可观测度分析方法来验证调整方案的可行性，即通过可观测度分析来判断以前不可观测的误差状态在调整后的系统运行状态下是否为可观测的。当不可观测的误差状态变为可观测的后，便可以利用Kalman滤波对其进行估计，利用滤波结果对惯性导航系统进行反馈校正从而提升系统导航定位精度。通过可观测度分析能够判断误差状态的Kalman滤波结果是否准确，进一步判断滤波结果能否应用于误差状态的反馈校正，而误差状态的反馈校正可以显著的提升惯性导航系统的导航定位精度，所以可观测度分析对于提高惯性导航系统的导航精度具有重要的意义。
技术实现思路
本专利技术的目的是为了克服已有技术存在的不足，提出了一种分析惯性导航系统可观测性的方法。该方法能够计算系统每一状态的可观测度，每一单一状态的可观测度能够比整个系统的可观测度更加准确而详细的描述系统的可观测性。本专利技术的目的是通过下述技术方案实现的。一种分析惯性导航系统可观测性的方法，具体过程为：步骤一，建立惯性导航系统的系统模型，所述系统模型包括误差模型和观 测方程；步骤二，对系统模型进行离散化处理，利用离散化后的系统模型构建可观测矩阵；步骤三，通过对可观测矩阵进行变换和求解，计算出系统全部状态的可观测度；步骤四，根据所述可观测度，分析出系统每一个状态的可观测性，进一步可以反应出该状态的Kalman滤波结果是否准确。进一步地，本专利技术所述误差模型如公式(1)所示：X·(t)=F(t)X(t)+w(t)---(1)]]>其中，t为时间值，w(t)表示惯性导航系统误差模型的系统噪声，F(t)为状态转移矩阵，X(t)表示惯性导航系统误差模型的状态向量，表示X(t)对时间t的一阶导数； 所述观测方程如公式(2)所示；Z(t)＝HX(t)+V(t)   (7)其中，Z(t)代表观测输出，V(t)表示误差模型的量测噪声，H为观测矩阵。进一步地，本专利技术所述可观测矩阵Q如公式(11)所示，Q=HHAHA2...HAl-1---(11)]]>其中，A为离散化后的系统状态转移矩阵，l为预设参数； 进一步地，本专利技术所述步骤三的具体过程为：301，将矩阵Q中的列向量依序命名为q1,q2,…,q10；定义整数i，满足i＝1,2…10； 将向量组{qj,1≤j≤10,j≠i本文档来自技高网...

【技术保护点】
一种分析惯性导航系统可观测性的方法，其特征在于，具体过程为：步骤一，建立惯性导航系统的系统模型，所述系统模型包括误差模型和观测方程；步骤二，对系统模型进行离散化处理，利用离散化后的系统模型构建可观测矩阵；步骤三，通过对可观测矩阵进行变换和求解，计算出系统全部状态的可观测度；步骤四，根据所述可观测度，分析出系统每一个状态的可观测性。

【技术特征摘要】
1.一种分析惯性导航系统可观测性的方法，其特征在于，具体过程为：
步骤一，建立惯性导航系统的系统模型，所述系统模型包括误差模型和观
测方程；
步骤二，对系统模型进行离散化处理，利用离散化后的系统模型构建可观
测矩阵；
步骤三，通过对可观测矩阵进行变换和求解，计算出系统全部状态的可观
测度；
步骤四，根据所述可观测度，分析出系统每一个状态的可观测性。
2.根据权利要求1所述分析惯性导航系统可观测性的方法，其特征在于，
所述误差模型如公式(1)所示：
X·(t)=F(t)X(t)+w(t)---(1)]]>其中，t为时间值，w(t)表示惯性导航系统误差模型的系统噪声，F(t)为状态转
移矩阵，X(t)表示惯性导航系统误差模型的状...

【专利技术属性】
技术研发人员：肖烜，梁源，付梦印，邓志红，王博，
申请(专利权)人：北京理工大学，
类型：发明
国别省市：北京;11