Sensor Netting via the Discrete Time Extended Kalman Filter

An implementation is presented of the discrete time extended Kalman filter which the authors have found useful for sensor netting in a variety of tactical radar and ballistic missile defense (BMD) applications. A Potter square root version of the extended Kalman filter is used where vector measurements are processed serially. Both the state and covariance equations are initialized by processing past measurements. The initialization technique and the filter are used in two tactical radar tracking examples.     

基于新息异常检测的改进抗差自适应卡尔曼滤波算法

在工程应用中,量测异常及量测噪声统计特性的时变是引起标准卡尔曼滤波振荡甚至发散的主要原因。经典抗差Sage-Husa自适应滤波方案,对量测中的孤立型异常有所抵抗,并可在线估计量测噪声统计特性改善滤波效果,但当连续型异常值出现时,其滤波效果不佳。针对现有抗差Sage-Husa自适应滤波方案的不足,提出了新的改进滤波方法。在改进算法中,当检测到量测异常时采用模值更大的先验预测方差阵代替原算法中的后验估计方差阵,在估计量测噪声方差时起到放大作用,以降低异常量测权重,提高滤波精度;采用IGG方案构造了新的权函数,可在抑制异常影响的同时调节估计方差阵,以免连续异常时新息持续置零引起的滤波发散;采用标准卡尔曼滤波新息辅助异常检测的双重检测策略,避免了因量测噪声方差阵的调节引起检测阈值变化而导致的漏检率增高。仿真实验表明,与常规抗差自适应滤波算法相比,该方案可更加有效地抑制量测异常值的影响。     

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     

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     

Rapid and robust initialization for monocular visual inertial navigation within multi-state Kalman filter

Sensor-fusion based navigation attracts significant attentions for its robustness and accuracy in various applications. To achieve a versatile and efficient state estimation both indoor and outdoor, this paper presents an improved monocular visual inertial navigation architecture within the Multi-State Constraint Kalman Filter (MSCKF). In addition, to alleviate the initialization demands by appending enough stable poses in MSCKF, a rapid and robust Initialization MSCKF (I-MSCKF) navigation method is proposed in the paper. Based on the trifocal tensor and sigma-point filter, the initialization of the integrated navigation can be accomplished within three consecutive visual frames. Thus, the proposed I-MSCKF method can improve the navigation performance when suffered from shocks at the initial stage. Moreover, the sigma-point filter is applied at initial stage to improve the accuracy for state estimation. The state vector generated at initial stage from the proposed method is consistent with MSCKF, and thus a seamless transition can be achieved between the initialization and the subsequent navigation in I-MSCKF. Finally, the experimental results show that the proposed I-MSCKF method can improve the robustness and accuracy for monocular visual inertial navigations.     

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

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

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 ...     

涡扇发动机故障诊断中粒子滤波改进方法

针对标准粒子滤波算法诊断步数多且诊断结果噪声水平高的问题,提出伪协方差和自适应似然分布结合的改进粒子滤波算法。该算法通过使用伪协方差代替了粒子集协方差,保证采样得到的粒子能够更真实地反映突变情况,减少诊断步数;通过对似然分布自适应调整,增加其与先验分布的重叠区域,提高抽样率,增加有效粒子数,降低诊断结果噪声水平。发动机健康参数估计仿真结果表明:与标准粒子滤波算法相比,改进的粒子滤波算法能使诊断速度提高约27%,诊断精度提高约38%,有效地减少了突变故障的诊断步数,并显著降低了诊断结果的噪声水平。     

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

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

基于改进联邦Kalman滤波的组合校准方法研究

联邦滤波器广泛应用于多传感器信息融合领域,联邦滤波中的信息分配原则影响滤波精度.针对联邦Kalman滤波器进行改进,采用基于估计协方差阵奇异值动态确定信息分配系数.对子滤波器进行重置时,采用新的重置方法,保证了子滤波器误差协方差阵的对称性,确保Kalman滤波器的一致收敛稳定性.新的联邦滤波算法允许每个状态分量拥有不同的动态信息分配因子,从而改进了联邦滤波信息融合的精度.设计了SINS/GPS/电子罗盘组合导航系统,仿真结果说明,与传统联邦滤波算法相比,改进的联邦滤波器估计精度得到了提高,可以更好地对SINS误差进行校准,提高系统的精度.     

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

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

Reduced state estimator for systems with parametric inputs

A reduced state estimator is derived for systems with bounded parameters as inputs. Optimal filter gains are derived for minimizing the total covariance of the estimation error due to measurement noise and parameter uncertainty. It is shown that these filter gains for a two-state system with a Gaussian parameter satisfy the Kalata relation in steady state. Equations are also derived for optimally filtering measurements in arbitrary time order. This reduced state estimator offers novelties over a traditional Kalman filter in its application to the class of problems considered. The total error covariance, which is minimized, makes no use of plant noise. Furthermore, the filter is easier to optimize in high dimensional and multiple sensor applications as well as in processing out-of-sequence measurements.     

Transient Response of Tracking Filters with Randomly Interrupted Data

The transient responses during the initialization phase of a first-order ?-? tracking filter and a second-order Kalman filter are evaluated as a function of radar measurement accuracy and the probability of receiving valid data at the prescribed intervals. Monte Carlo simulation results are complemented by analysis of the filtering processes and curves are presented which clearly define the deterioration in filter performance attributable to reduced probabilities of data acquisition. In addition, the responses of ?-? and Kalman filters are shown to be identical when the ?, ? gains are selected optimally.     

Observability, Eigenvalues, and Kalman Filtering

In higher order Kalman filtering applications the analyst often has very little insight into the nature of the observability of the system. For example, there are situations where the filter may be estimating certain linear combinations of state variables quite well, but this is not apparent from a glance at the error covariance matrix. It is shown here that the eigenvalues and eigenvectors of the error covariance matrix, when properly normalized, can provide useful information about the observability of the system.     

Novel quaternion Kalman filter

This paper presents a novel Kalman filter (KF) for estimating the attitude-quaternion as well as gyro random drifts from vector measurements. Employing a special manipulation on the measurement equation results in a linear pseudo-measurement equation whose error is state-dependent. Because the quaternion kinematics equation is linear, the combination of the two yields a linear KF that eliminates the usual linearization procedure and is less sensitive to initial estimation errors. General accurate expressions for the covariance matrices of the system state-dependent noises are developed. In addition, an analysis shows how to compute these covariance matrices efficiently. An adaptive version of the filter is also developed to handle modeling errors of the dynamic system noise statistics. Monte-Carlo simulations are carried out that demonstrate the efficiency of both versions of the filter. In the particular case of high initial estimation errors, a typical extended Kalman filter (EKF) fails to converge whereas the proposed filter succeeds.     

Kalman Filter Compensation for a Special Class of Systems

Filter compensation techniques for several special but practical cases are discussed. A general set of bias and covariance equations for linear filters with modeling errors is first summarized. A method for relating the modeling errors to the selection of the covariance of "process noise" for model error compensation is suggested. A performance ordering for cases when the true system becomes a subsystem of the model used for the filter construction is given. A bias correcting filter is derived for the case when the filter is matched only to a subsystem of the actual system.     

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     

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.     

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

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

非高斯杂波下自适应雷达目标检测新方法

在球不变随机向量(SIRV)非高斯杂波背景下,研究了多脉冲相参雷达目标的自适应检测问题。假设杂波具有相同的协方差矩阵结构和可能相关的纹理分量,提出了新的协方差矩阵估计器,并获得了相应的自适应归一化匹配滤波器(ANMF)。理论分析表明,在估计杂波分组大小与实际情况匹配时,所获得的ANMF对杂波功率水平和协方差矩阵结构均具有恒虚警率(CFAR)特性。仿真结果表明:当估计的杂波分组大小失配时,所获得的ANMF具有近似CFAR特性,并进一步分析了不同参数变化对所提检测器性能的影响。与已有的ANMF相比,所获得的ANMF具有更好的检测性能,且迭代次数更小,其相对于已知杂波协方差矩阵的最优归一化匹配滤波器(NMF)的检测损失也更小,具有很好的实际应用前景。