首页> 外国专利> METHOD FOR EVALUATING THE NAVIGATIONAL CONDITION IN THE CONDITIONS OF A LIMITED OBSERVANCE OPPORTUNITY

METHOD FOR EVALUATING THE NAVIGATIONAL CONDITION IN THE CONDITIONS OF A LIMITED OBSERVANCE OPPORTUNITY

机译:在有限观察机会条件下评估航行条件的方法

摘要

There is proposed a method of estimating a navigation state with several variables of a mobile carrier according to the extended Kalman filter method, comprising the steps of:—acquisition of measurements of at least one of the variables,—extended Kalman filtering (400) producing a current estimated state and a covariance matrix delimiting in the space of the navigation state a region of errors, with the help of a previous estimated state, of an observation matrix, of a transition matrix and of the measurements acquired, the method being characterized in that it comprises a step (310, 330) of adjustment of the transition matrix and of the observation matrix before their use in the extended Kalman filtering in such a way that the adjusted matrices satisfy an observability condition which depends on at least one of the variables of the state of the carrier, the observability condition being adjusted so as to prevent the Kalman filter from reducing the dimension of the region along at least one non-observable axis of the state space, in which the observability condition to be satisfied by the adjusted transition and observation matrices is the nullity of the kernel of an observability matrix associated therewith and in which the adjustment comprises the steps of:—calculation (301) of at least one primary basis of non-observable vectors with the help of the previous estimated state—for each matrix to be adjusted, calculation (306, 308) of at least one matrix deviation associated with the matrix with the help of the primary basis of vectors, shifting (330) of each matrix to be adjusted according to the matrix deviation associated therewith so as to satisfy the observability condition.
机译:提出了一种根据扩展卡尔曼滤波器方法用移动载波的多个变量来估计导航状态的方法,该方法包括以下步骤:-获取至少一个变量的测量值,-扩展卡尔曼滤波(400)产生当前的估计状态和协方差矩阵,在导航状态的空间中,在先前的估计状态,观测矩阵,转换矩阵和所获取的测量值的帮助下界定误差区域,该方法的特征在于它包括步骤(310、330),在过渡矩阵和观察矩阵用于扩展卡尔曼滤波之前进行调整(310、330),以使调整后的矩阵满足取决于至少一个变量的可观察性条件在载体状态的基础上,调整可观察性条件,以防止卡尔曼滤波器减小沿滤光片的区域尺寸t状态空间的一个不可观测轴,其中已调整的过渡和观测矩阵要满足的可观测条件是与之关联的可观测矩阵的核的零值,并且其中的调整包括以下步骤:-计算(301)借助于先前的估计状态,对不可观测向量的至少一个主要基础进行调整-对于每个要调整的矩阵,借助以下公式,计算(306,308)与该矩阵相关联的至少一个矩阵偏差作为向量的主要基础,每个矩阵的移位(330)将根据与其相关的矩阵偏差进行调整,从而满足可观察性条件。

著录项

相似文献

  • 专利
  • 外文文献
  • 中文文献
获取专利

客服邮箱:kefu@zhangqiaokeyan.com

京公网安备:11010802029741号 ICP备案号:京ICP备15016152号-6 六维联合信息科技 (北京) 有限公司©版权所有
  • 客服微信

  • 服务号