Fusion of distributed extended forgetting factor RLS state estimators

For single-target multisensor systems, two fusion methods are presented for distributed recursive state estimation of dynamic systems without knowledge of noise covariances. The estimator at every local sensor embeds the dynamics and the forgetting factor into the recursive least squares (RLS) method to remedy the lack of knowledge of noise statistics, developed before as the extended forgetting factor recursive least squares (EFRLS) estimator. It is proved that the two fusion methods are equivalent to the centralized EFRLS that uses all measurements from local sensors directly and their good performance is shown by simulation examples.     

基于改进强跟踪ASCKF算法的SINS/GNSS组合对准方法

大方位失准角下的SINS/GNSS组合对准系统呈非线性,采用传统的卡尔曼滤波方法进行初始对准易导致对准精度下降甚至滤波发散。基于此,提出了一种基于改进强跟踪自适应平方根容积卡尔曼滤波算法的组合对准方法。该方法采用QR分解求取协方差的分解因子,并在状态预测方差阵的平方根更新中引入多重渐消因子调整滤波增益;同时,基于Sage-Husa自适应滤波,引入改进的时变噪声估计器实时估计噪声的统计特性。仿真结果表明,采用改进的滤波算法进行大方位失准角下的组合对准,对准精度明显提高。     

自校准Kalman滤波方法

提出一种自校准Kalman滤波方法(SKF),建立SKF模型及其滤波递推算法.在深空探测、发动机故障诊断等许多工程实际中,由于未知输入(如突风、故障、未知的系统误差等)的影响,传统的Kalman滤波方法在滤波递推过程中会产生较大误差.文中提出的自校准Kalman滤波方法能够自动补偿这种未知输入的影响,提高滤波精度.从某飞行器仿真中可以看到,SKF的滤波误差均值和方差分别比传统的Kalman滤波方法降低了400%和300%以上,有效地改善了滤波效果.并且该方法计算简单,便于工程应用.     

改进的Sage-Husa自适应滤波算法在MEMS航姿参考系统中的应用

针对经典Kalman滤波和扩展Kalman滤波融合算法存在的计算量大、精度低、实时性差的缺点，引入了改进的Sage-Husa自适应扩展Kalman滤波算法。该算法对经典扩展Kalman滤波算法进行了自适应改进，并在此基础上利用加权渐消记忆法获取了遗忘因子，并通过预测残差得出了最优解。同时，用调整有偏增益估计的措施来保证系统噪声预测方差矩阵与噪声预测方差矩阵的对称性和正定性，对滤波器发散进行了有效的抑制，减少了算法的计算量。实验结果表明，该算法有效改善了可靠性、精确性及自适应能力。     

MAP estimation of target manoeuvre sequence with theexpectation-maximization algorithm

Two algorithms are derived for the problem of tracking a manoeuvring target based on a sequence of noisy measurements of the state. Manoeuvres are modeled as unknown input (acceleration) terms entering linearly into the state equation and chosen from a discrete set. The expectation maximization (EM) algorithm is first applied, resulting in a multi-pass estimator of the MAP sequence of inputs. The expectation step for each pass involves computation of state estimates in a bank of Kalman smoothers tuned to the possible manoeuvre sequences. The maximization computation is efficiently implemented using the Viterbi algorithm. A second, recursive estimator is then derived using a modified EM-type cost function. To obtain a dynamic programming recursion, the target state is assumed to satisfy a Markov property with respect to the manoeuvre sequence. This results in a recursive but suboptimal estimator implementable on a Viterbi trellis. The transition costs of the latter algorithm, which depend on filtered estimates of the state, are compared with the costs arising in a Viterbi-based manoeuvre estimator due to Averbuch, et al. (1991). It is shown that the two criteria differ only in the weighting matrix of the quadratic part of the cost function. Simulations are provided to demonstrate the performance of both the batch and recursive estimators compared with Averbuch's method and the interacting multiple model filter     

包含乘性噪声自适应修正的非合作目标相对导航算法

无人机（UAV）态势感知的任务是利用机载传感器对未知环境进行目标识别和引导，针对无人机与非合作目标间中远距离的相对导航问题，提出了一种基于角度和距离量测的相对状态估计算法。在现有滤波算法的基础上，为了提高精度和稳定性，本文利用了列文伯格-马夸尔特（LM）优化的思想对迭代卡尔曼滤波（IEKF）算法进行改进，提出了一种LM-IEKF算法，并推导该算法在迭代过程中的状态更新方程及协方差阵的递推公式。在此基础上，考虑到距离传感器由于信号相关特性而引入的乘性噪声，现有的加性噪声模型难以适应，因此，进一步提出了基于量测噪声自适应修正的Modified LM-IEKF方法，通过在线实时更新噪声阵提高滤波的精度，并设置渐消记忆指数平滑估计结果。算法验证结果表明，与现有的EKF、IEKF算法相比，在仅含加性噪声的情况下，LM-IEKF算法具有更好的性能；在包含乘性噪声的情况下，Modified LM-IEKF可以有效地估计量测噪声，与目前广泛使用的EKF算法相比，在综合相对位置和相对速度精度上分别提高了10%和23%。     

A Kalman Tracker with a Simple Input Estimator

Two Kalman filter based schemes are proposed for tracking maneuvering targets. Both schemes use least squares to estimate a target's acceleration input vector and to update the tracker by this estimate. The first scheme is simpler and by an approximation to its input estimator the computation can be considerably reduced with insignificant performance degradation. The second scheme requires two Kalman filters and hence is more complex. However, since one of its two filters assumes input noise, it may outperform the first scheme when input noise is indeed present. A detector that compares the weighted norm of the estimated input vector to a threshold is used in each scheme. Its function is to guard against false updating of the trackers and to keep the error covariance small during constant velocity tracks. Simulation results for various target profiles are included. They show that in terms of tracking performance, both schemes are comparable. However, because of its computation simplicity, the first scheme is far superior.     

非线性状态方程自校准滤波方法

针对工程实际中遇到的非线性系统状态方程中含未知输入（如环境因素的影响、模型和参数选取不当等）的情况，采用自校准技术，基于秩滤波与无迹Kalman滤波算法提出了一种非线性状态方程自校准滤波方法,并分别讨论了自校准秩滤波(SRF)与自校准无迹Kalman滤波(SUKF)两种情况。大量仿真结果和工程应用表明:与无迹Kalman滤波(UKF)相比，该方法通过对系统状态方程中的未知输入进行自动估计和补偿，改善了系统受未知输入影响下的滤波效果，从算例中可以看到，估计精度至少提高了80%，且计算简单，便于工程应用。      

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

State Estimation and Divergence Analysis

A growing memory discrete dynamic model for performing temporal extrapolations along a predetermined path in a random field is presented. This dynamic model is used to drive a linear system that is itself driven by discrete white noise. The coupled system is used to derive a state estimation scheme that recursively processes noisy measurements of the system. In addition, using the aforementioned dynamic model as a reference (truth) model, the authors develop a covariance analysis to measure the estimation errors that occur when the dynamics along the path through the field are modeled as a Markov linear model and state estimation is performed using discrete Kalman filtering. The performance evaluation of an inertial navigation system influenced by the Earth's gravity field aboard a maneuvering ship is provided as a specific illustrative example.     

一种线运动扰动环境下基于惯性凝固系抗干扰自对准优化算法研究

传统惯性凝固性对准技术可有效隔离角运动干扰环境对捷联惯导自对准精度的影响,但对线运动环境下的抗干扰能力不足.据此,在深入分析线运动干扰对捷联惯导惯性凝固系下自对准精度影响途径之上,对线运动干扰环境划分为速度周期波动、突跳以及速度短期线性漂移.提出采用积分降噪、载体惯性系速度递推拟合与基于带遗忘因子递推最小二乘的速度慢漂提取技术相结合的抗干扰自对准优化算法,并进行了试验验证.试验结果表明,本算法可在5min内实现1.3mil的抗干扰自对准精度.     

利用卡尔曼滤波求取直升机气动导数的应用研究

本文主要介绍利用低通滤波、卡尔曼滤波及最小二乘法求取直升机气动导数的方法。本方法的特点是,通过低通滤波使旋翼高频成份的影响减至最小,同时求取试验数据的测量噪声和过程噪声,然后通过卡尔曼滤波使试验数据包含的随机噪声减至最小,最后用最小二乘法求得直升机的气动导数,为了提高卡尔曼滤波的准确度,用最小二乘法由试验数据求取直升机的气动导数作为卡尔曼滤波时的初始导数。计算结果表明,该方法可使试验数据中包含的噪声大大减小,误差带减少70％以上,而计算工作量又远远小于最大似然法。     

Fast automatic leveling subject to abrupt deterministic input

This investigation applies a modified Kalman filter with a recursive generalized M estimator (GME) of input to a class of leveling problems, that are subject to abrupt environmental disturbances and high noise levels. A least-squares estimator (LSE) based hypothetical testing scheme is also devised to detect the onset and presence of the input. Simulation results demonstrate that the leveling speed of convergence and accuracy is markedly higher than the original unmodified one     

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.     

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.     

基于ATSUKF算法的卫星姿控系统故障估计

针对卫星姿态控制过程中可能发生的执行机构或敏感器故障，提出了一种基于无损卡尔曼滤波（UKF）及偏差分离原理的自适应二阶无损卡尔曼滤波（ATSUKF）算法。首先，提出TSUKF算法，通过UKF处理姿态机动时的非线性并通过偏差分离原理将非线性系统的状态及故障分别估计，避免非线性模型的线性化过程同时降低了计算过程中的矩阵维度。然后，在TSUKF算法的基础上提出了ATSUKF算法，通过滑动窗口内的残差计算自适应矩阵，使滤波器在统计特性不准确的情况下仍然具有较快的收敛速度，特别适用于卫星快速机动过程中的姿态与故障估计。数值仿真结果表明，ATSUKF算法相较于TSUKF算法能有效降低统计特性不准对系统造成的不利影响，实现卫星姿态、执行机构/敏感器故障的快速估计。     

Recursive 3-D motion estimation from a monocular image sequence

Consideration is given to the design and application of a recursive algorithm to a sequence of images of a moving object to estimate both its structure and kinematics. The object is assumed to be rigid, and its motion is assumed to be smooth in the sense that it can be modeled by retaining an arbitrary number of terms in the appropriate Taylor series expansions. Translational motion involves a standard rectilinear model, while rotational motion is described with quaternions. Neglected terms of the Taylor series are modeled as process noise. A state-space model is constructed, incorporating both kinematic and structural states, and recursive techniques are used to estimate the state vector as a function of time. A set of object match points is assumed to be available. The problem is formulated as a parameter estimation and tracking problem which can use an arbitrarily large number of images in a sequence. The recursive estimation is done using an iterated extended Kalman filter (IEKF), initialized with the output of a batch algorithm run on the first few frames. Approximate Cramer-Rao lower bounds on the error covariance of the batch estimate are used as the initial state estimate error covariance of the IEKF. The performance of the recursive estimator is illustrated using both real and synthetic image sequences     

传感器位置误差条件下的约束总体最小二乘时差定位算法

 现代定位系统中,传感器往往被安放在运动平台上,其位置无法精确得知,存在估计误差,将严重影响对目标的定位精度。针对这一问题,提出基于约束总体最小二乘(CTLS)的到达时差(TDOA)定位算法。首先通过引入中间变量,将非线性TDOA定位方程转化为伪线性方程,再利用CTLS技术,全面考虑伪线性方程所有系数中的噪声。在此基础上推导了定位方程的目标函数,再根据牛顿迭代方法,进行数值迭代,快速得到精确解。采用一阶小噪声扰动分析方法,对该算法的理论性能进行了分析,证明了算法的无偏性和逼近克拉美-罗下限(CRLB)。仿真实验表明,该算法克服了现有总体最小二乘(TLS)算法不能达到CRLB、两步加权最小二乘(two-step WLS)算法在较高噪声时性能发散的缺陷,在较高噪声时定位精度仍然能达到CRLB。     

递推阻尼最小二乘法及其在火控系统中的应用

由于火控系统误差模型未知且稳定性较差,采用Kalman滤波实现滤波时,其滤波特性较差;而此时最小二乘法是实际工程应用中的常用方法,但是容易产生参数爆发现象。文中提出了一种基于多输入-多输出(MI-MO)系统的递推阻尼最小二乘法,将其应用到火控滤波系统中。仿真结果表明,利用递推阻尼最小二乘法能达到递推最小二乘法同样的精度,且能明显抑制参数爆发现象,达到良好的滤波效果。     

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.