A new adaptive Kalman filter for navigation systems of carrier-based aircraft

The features of carrier-based aircraft’s navigation systems during the approach and landing phases are investigated. A new adaptive Kalman filter with unknown state noise statistics is proposed to improve the accuracy of the INS/GNSS integrated navigation system. The adaptive filtering algorithm aims to estimate and adapt the unknown state noise covariance Q in high dynamic conditions, when the measurement noise covariance R is assumed to be known empirically in advance. The new adaptive Kalman ...     

组合导航系统中一种基于特征值分解的自适应信息融合滤波算法

基于分散滤波理论的联合滤波算法,可以有效地降低组合导航系统的计算负担,并且增强系统的容错性能。给出了一种联合滤波算法中信息分配系数的自适应计算方法,能够使联合系统根据导航过程中各传感器的信息质量的变化合理地反馈全局信息。仿真结果表明,该算法可以有效地降低由于导航子系统降级带来的滤波误差。     

多渐消因子Kalman滤波器在SINS初始对准中的应用(英文)

针对系统模型和统计信息不能精确已知的条件下Kalman滤波无法给出最优解这一问题,单一渐消因子Kalman滤波算法对于简单的系统是有效的,但是对于复杂的多变量系统,仅仅利用单个的渐消因子是不够的。本文提出了一种多渐消因子滤波算法,通过利用开窗法计算新息序列协方差的无偏估计获得渐消因子矩阵。利用渐消因子矩阵调节一步预测均方误差矩阵k|k1P,对不同的滤波通道提供不同的渐消速率。将该方法应用于SINS的初始对准中,仿真和试验结果表明:当真实系统噪声统计特性同设定参数不一致时,对准精度明显高于其他滤波算法。其对不确定性噪声具有较低的敏感度,对系统参数具有较好的滤波效果。因而,在实际应用中具有重要的参考价值。     

低成本的多普勒-捷联惯性组合导航系统

本文研究了一种采用低精度的惯性器件,应用卡尔曼滤波技术的多普勒捷联惯性组合导航系统。讨论了组合方案,推导了系统的动态方程,设计了一种最优和四种次优卡尔曼滤波器。对系统进行了协方差分析。分析结果表明,采用随机漂移为0.1°/h的陀螺仪,零位误差为10^-4g的加速度计,应用卡尔曼滤波技术可以实现1nmile/h的导航精度,成为一种低成本、中等精度的导航系统。     

On a decoupled multitarget tracking algorithm

An analysis is conducted of the optimality of a decoupled tracking filtering algorithm for addressing the problem of tracking multiple targets with correlated measurements and maneuvers. It is proved that the decoupled filters are, in general, suboptimal and are not in fact Kalman filters. However, it is shown also that if the standard Kalman filter is asymptotically stable, the decoupled filters will converge asymptotically to the stable version of the standard Kalman filter. For the case of time-invariant measurement and process noise covariance, a simple sufficient condition guaranteeing the asymptotical stability of the decoupled filters are given     

自适应高阶容积卡尔曼滤波在目标跟踪中的应用

针对传统容积卡尔曼滤波(CKF)在系统状态发生突变时估计精度下降的问题,将强跟踪滤波(STF)算法与高阶容积卡尔曼滤波(HCKF)算法相结合,提出了一种自适应高阶容积卡尔曼滤波(AHCKF)方法。该算法采用高阶球面-相径容积规则,可获得高于传统CKF的估计精度,同时在HCKF算法中引入STF,通过渐消因子在线修正预测误差协方差阵,强迫残差序列正交,提高了算法的鲁棒性,增强了算法应对系统状态突变等不确定因素的能力。将提出的AHCKF算法应用于具有状态突变的机动目标跟踪问题并进行数值仿真,仿真结果表明,AHCKF算法在系统状态发生突变的情况下表现出良好的滤波性能,有效地避免了状态突变造成的滤波精度下降,较传统的CKF、HCKF、交互式多模型-容积滤波(IMM-CKF)和自适应容积卡尔曼滤波(ACKF)算法有更强的鲁棒性和系统自适应能力。     

Convolution Particle Filter for Parameter Estimation in General State-Space Models

The state-space modeling of partially observed dynamical systems generally requires estimates of unknown parameters. The dynamic state vector together with the static parameter vector can be considered as an augmented state vector. Classical filtering methods, such as the extended Kalman filter (EKF) and the bootstrap particle filter (PF), fail to estimate the augmented state vector. For these classical filters to handle the augmented state vector, a dynamic noise term should be artificially added to the parameter components or to the deterministic component of the dynamical system. However, this approach degrades the estimation performance of the filters. We propose a variant of the PF based on convolution kernel approximation techniques. This approach is tested on a simulated case study.     

Characterization of Kalman filter residuals in the presence ofmismodeling

The mean and covariance of a Kalman filter residual are computed for specific cases in which the Kalman filter model differs from a linear model that accurately represents the true system (the truth model). Multiple model adaptive estimation (MMAE) uses a bank of Kalman filters, each with a different internal model, and a hypothesis testing algorithm that uses the residuals from this bank of Kalman filters to estimate the true system model. At most, only one Kalman filter model will exactly match the truth model and will produce a residual whose mean and standard deviation have already been analyzed. All of the other filters use internal models that mismodel the true system. We compute the effects of a mismodeled input matrix, output matrix, and state transition matrix on these residuals. The computed mean and covariance are compared with simulation results of flight control failures that correspond to mismodeled input matrices and output matrices     

自适应滤波技术的研究

应用常规卡尔曼滤波器(KF)要求知道系统精确的数学模型和系统噪声与量测噪声的统计特性,才能获得理想的滤波效果,否则可能产生发散现象。人们越来越倾向于利用自适应滤波(AKF)技术来解决发散的问题。针对AKF技术的研究现状,本文探讨一种结构简单、实时性较强、工程上比较实用的AKF算法。仿真结果表明,这种算法具有较强的自适应性,为一种实用而有效的滤波方法。     

Robust adaptive filtering method for SINS/SAR integrated navigation system

This paper presents a new robust adaptive filtering method for SINS/SAR (Strap-down Inertial Navigation System/Synthetic Aperture Radar) integrated navigation system. This method adopts the principle of robust estimation to adaptive filtering of observational data. A robust adaptive filter is developed to adaptively determine the covariance matrix of observation noise, and adaptively adjust the covariance matrix of system state noise according to the adaptive factor constructed based on predicted residuals. Experimental results and comparison analysis demonstrate that the proposed method cannot only effectively resist disturbances due to system state noise and observation noise, but it can also achieve higher accuracy than the adaptive Kalman filtering method.     

A practical filter error method for aerodynamic parameter estimation of aircraft in turbulence

It is common for aircraft to encounter atmospheric turbulence in flight tests. Turbulence is usually modeled as stochastic process noise in the flight dynamics equations. In this paper, parameter estimation of nonlinear dynamic system with both process and measurement noise was studied, and a practical filter error method was proposed. The linearized Kalman filter of first-order approximation was used for state estimation, in which the filter gain, along with the system parameters and the initial states, constituted the parameter vector to be estimated. The unknown parameters and measurement noise covariance were estimated alternately by a relaxation iteration method, and the sensitivities of observations to unknown parameters were calculated by finite difference approximation. Some practical aspects of the method application were discussed. The proposed filter error method was validated by the flight simulation data of a research aircraft. Then, the method was applied to the flight tests of a subscale aircraft, and the aerodynamic stability and control derivatives were estimated. All the estimation results were compared with the results of the output error method to demonstrate the effectiveness of the approach. It is shown that the filter error method is superior to the output error method for flight tests in atmospheric turbulence.     

基于模糊自适应扩展卡尔曼滤波器的异步电动机无速度传感器控制

针对传统扩展卡尔曼滤波器(EKF)固定的噪声协方差矩阵在观测感应电动机转速时不能同时满足系统动态和静态下精确估计的问题,提出了一种模糊自适应调整噪声协方差的方法。该方法可以根据状态鉴别器输出状态,经模糊自适应调整噪声协方差矩阵参数,解决了系统在动态和静态时对噪声协方差矩阵中不同参数需求的问题。仿真表明所提模糊自适应EKF转速估计精度更高,有效地提高了系统的抗干扰能力。     

Efficient L-D factorization algorithms for PDA, IMM, and IMMPDAfilters

Efficient algorithms exist for the square-root probabilistic data association filter (PDAF). The same approach is extended to develop square-root versions of the interacting multiple model (IMM) Kalman filter and the IMMPDAF algorithms. The computational efficiency of the method stems from the fact that the terms needed in the overall covariance updates of PDAF, IMM, and IMMPDAF can be obtained as part of the square-root covariance update of an ordinary Kalman filter. In addition, a new square-root covariance prediction algorithm that is substantially faster than the usual modified weighted Gram-Schmidt (MWG-S) algorithm, whenever the process noise covariance matrix is time invariant, is proposed     

Square root parallel Kalman filtering using reduced-order localfilters

The basic parallel Kalman filtering algorithms derived by H.R. Hashemipour et al. (IEEE Trans. Autom. Control. vol.33, p.88-94, 1988) are summarized and generalized to the case of reduced-order local filters. Measurement-update and time-update equations are provided for four implementations: the conventional covariance filter, the conventional information filter, the square-foot covariance filter, and the square-foot information filter. A special feature of the suggested architecture is the ability to accommodate parallel local filters that have a smaller state dimension than the global filter. The estimates and covariance or information matrices (or their square roots) from these reduced-order filters are collated at a central filter at each step to generate the full-size, globally optimal estimates and their associated error covariance or information matrices (or their square roots). Aspects of computational complexity and the ensuing tradeoff with communication are discussed     

鲁棒EKF在脉冲星导航系统中的应用

针对脉冲星导航系统的滤波问题,传统的扩展卡尔曼滤波(EKF)算法存在不能克服系统模型存在不确定性参数以及乘性噪声等缺陷,提出一种鲁棒EKF算法。首先,分析了状态预测误差方程和估计误差方程,利用统计学原理,得到了状态预测方差矩阵和状态估计方差矩阵计算等式。由于系统模型存在不确定性参数,状态预测协方差矩阵和状态估计协方差矩阵无法计算;因此,利用4个重要矩阵不等式,分析并找到预测方差矩阵和状态估计方差矩阵的上界。最后,利用状态估计误差协方差矩阵上界设计状态增益矩阵,使得状态估计协方差矩阵的迹最小。将该算法对脉冲星导航系统进行仿真,仿真结果验证了所提算法的有效性。     

SINS／GPS／CNS组合导航中的鲁棒滤波算法研究

组合导航系统难以精确建模、噪声统计特性难以获得等问题逐渐突出,严重影响了组合导航系统滤波器的稳定性。为提高SINS／GPS／CNS组合导航系统的鲁棒性,设计了基于H∞滤波理论的鲁棒滤波算法,提高了导航系统对系统模型参数变化的适应能力。通过仿真与线性卡尔曼滤波器进行对比,验证了在系统模型参数变化的情况下,H∞滤波器精度几乎不发生改变,有更好的鲁棒性;提高了组合导航系统在噪声统计特性和模型参数不易确定情况下的导航性能。     

Coordinate Conversion and Tracking for Very Long Range Radars

The problem of tracking with very long range radars is studied in this paper. First, the measurement conversion from a radar's r-u-v coordinate system to the Cartesian coordinate system is discussed. Although the nonlinearity of this coordinate transformation appears insignificant based on the evaluation of the bias of the converted measurements, it is shown that this nonlinearity can cause significant covariance inconsistency in the conventionally converted measurements (CM1). Since data association depends critically on filter consistency, this issue is very important. Following this, it is shown that a suitably corrected conversion (CM2) eliminates the inconsistency. Then, initialized with the converted measurements (using CM2), four Cartesian filters are evaluated. It is shown that, among these filters, the converted measurement Kalman filter with second order Taylor expansion (CM2KF) is the only one that is consistent for very long range tracking scenarios. Another two approaches, the range-direction-cosine extended Kalman filter (ruvEKF) and the unscented Kalman filter (UKF) are also evaluated and shown to suffer from consistency problems. However, the CM2KF has the disadvantage of reduced accuracy in the range direction. To fix this problem, a consistency-based modification for the standard extended Kalman filter (E1KF) is proposed. This leads to a new filtering approach, designated as measurement covariance adaptive extended Kalman filter (MCAEKF). For very long range tracking scenarios, the MCAEKF is shown to produce consistent filtering results and be able to avoid the loss of accuracy in the range direction. It is also shown that the MCAEKF meets the posterior Carmer-Rao lower bound for the scenarios considered.     

The effect of the clutter-to-noise ratio on Doppler filterperformance

The effect of the clutter-to-noise ratio on the performance of a Doppler filter is considered. Clutter is assumed to have a power level which is unknown and varies in range. The assessment of the performance of a Doppler filter is based on the gain of the filter, which is the normalized output signal-to-interference ratio improvement at a given Doppler. The gain is generally a complex function of the statistics of the clutter. New upper and lower bounds on the gain differential between the expected design point clutter-to-noise ratio and the actual clutter-to-noise ratio are found. These bounds are independent of the clutter covariance matrix and are only a function of the unknown clutter-to-noise ratio. The bounds are valid for both Gaussian and non-Gaussian noise and for arbitrary linear filters. The upper and lower bounds differ by the theoretical coherent integration gain, 10 logN dB, where N is the number of pulses. A tighter lower bound is found for the case when the filters are matched filters. A simple exact expression is found for matched filters assuming a Gaussian Markov clutter model as the clutter spectral width approaches zero. An easily implementable adaptive procedure is given which improves performance due to the unknown clutter-to-noise ratio. This work extends a previous result, valid for the Emerson filter, that shows the effect of clutter-to-noise ratio on performance in terms of an average quantity, the improvement factor     

Spectral Analysis of Optimal and Suboptimal Gyro Monitoring Filters

Gyro monitoring filters are used to estimate and correct gyro drift rates of local-level inertial navigation systems. Conventional gyro monitoring filters are usually designed based on a simplified model of gyro drift rate. Furthermore, the effectiveness of these filters-and of many filters of the "Kalman" type-is often measured in terms of the root mean square (rms) criterion in contrast to the spectral content criterion typical of classical Wiener filtering theory. This paper has two objectives: to propose a gyro monitoring filter which is based on a more detailed model of gyro drift rate; and to propose a method of filter performance evaluation which uses as criterion a measure of the spectral content of the error process. The proposed gyro monitoring filter is shown to have improved spectral contents resulting in superior navigation performance for the gyro error models used in the calculations (comparable to commercial-grade aircraft gyros).     

Federated square root filter for decentralized parallel processors

An efficient, federated Kalman filter is developed for use in distributed multisensor systems. The design accommodates sensor-dedicated local filters, some of which use data from a common reference subsystem. The local filters run in parallel, and provide sensor data compression via prefiltering. The master filter runs at a selectable reduced rate, fusing local filter outputs via efficient square root algorithms. Common local process noise correlations are handled by use of a conservative matrix upper bound. The federated filter yields estimates that are globally optimal or conservatively suboptimal, depending upon the master filter processing rate. This design achieves a major improvement in throughput (speed), is well suited to real-time system implementation, and enhances fault detection, isolation, and recovery capability