Estimation Using Stochastic Feedback with Applications to Integrated Navigation Systems

This paper discusses an approach to linear estimation through use of a "control" fed back into the system to cancel out the effect of disturbances or error signals. Although this approach has very restricted application, it has found important usage in integrated navigation systems where one subsystem is an inertial measurement system. This approach is shown to be suboptimal and is compared with the optimal with respect to estimation accuracy and sensitivity to modeling errors. The feedback approach to estimation is shown to be similar to error estimation and correction in which the error states of the system are estimated and external correction applied. For discrete estimation using the feedback approach it is shown that error variance and Kalman gains for one-stage prediction should be used. Two examples are considered which compare the feedback approach to the optimum estimation approach. The system of the first example is quite simple, but provides simple analytical comparisons of the two estimation approaches. The second example system consists of a single-axis inertial guidance system and an independent position measuring system. Accuracy and sensitivity to modeling errors are compared. Other advantages and disadvantages of the two estimation approaches are discussed.     

基于冗余伪观测的自适应滤波算法

现有的二阶互差分(SOMD)算法能够给出与状态估计误差解耦的观测噪声协方差估计，但是需要满足冗余测量的条件，但这一条件往往难以满足。 针对这一问题，提出了一种利用状态预测值构造相邻2个时刻伪观测的方法，将原SOMD算法扩展到具有单测量的系统中。使用目标跟踪问题对该算法的有效性进行验证。仿真结果表明，当采样周期较小时，该算法能够忽略状态估计误差的影响并给出较准确的观测噪声方差，在精度和鲁棒性方面优于其他参考算法。     

A novel optimal data fusion algorithm and its application for the integrated navigation system of missile

For Inertial Navigation System(INS)/Celestial Navigation System(CNS)/Global Navigation Satellite System(GNSS) integrated navigation system of the missile, the performance of data fusion algorithms based on the Cubature Kalman Filter(CKF) is seriously degraded when there are non-Gaussian noise and process-modeling errors in the system model. Therefore, a novel method is proposed, which is called Optimal Data Fusion algorithm based on the Adaptive Fading maximum Correntropy generalized high-degree...     

Carrier phase navigation architecture for shipboard relative GPS

Carrier phase differential GPS (DGPS) navigation architectures and algorithms for automatic shipboard landing of aircraft are described. Processing methodologies are defined to provide high integrity carrier phase cycle estimation and positioning by optimally exploiting the complementary benefits of measurement filtering and satellite geometric redundancy for the terminal navigation problem. Navigation performance sensitivity to the standard deviations of raw carrier and code phase measurement errors, measurement error correlation times, and the filtering duration is quantified. Necessary conditions to ensure acceptable terminal navigation availability are specifically defined.     

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

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

In-Flight Alignment and Calibration of Inertial Measurement Units?Part II: Experimental Results

This is the second part of a two-part paper which summarizes work pursued by the author in 1967 [2]. The paper describes the application of minimum-variance estimation techniques for in-flight alignment and calibration of an inertial measurement unit (IMU) relative to another IMU and/or some other reference. The first paper [1] formulates the problem, and this paper reports numerical results and analyses. The approach taken is to cast the problem into the framework of Kalman-Bucy estimation theory, where velocity and position differences between the two IMU's are used as observations and the IMU parameters of interest become part of the state vector. Instrument quantization and computer roundoff errors are considered as measurement noise, and environmental induced random accelerations are considered as state noise. In this paper, numerical results for three important IMU error parameter configurations are presented and discussed. The main results of the paper determine the effects of state and observation noise levels and the nominal trajectory on the identifications of the errors for these configurations. A discussion of the minimum number of trajectory maneuvers and of the optimal trajectory maneuvering is given.     

Discrete-time min-max tracking

The problem of optimal state estimation of linear discrete-time systems with measured outputs that are corrupted by additive white noise is addressed. Such estimation is often encountered in problems of target tracking where the target dynamics is driven by finite energy signals, whereas the measurement noise is approximated by white noise. The relevant cost function for such tracking problems is the expected value of the standard H/sub /spl infin// performance index, with respect to the measurement noise statistics. The estimator, serving as a tracking filter, tries to minimize the mean-square estimation error, and the exogenous disturbance, which may represent the target maneuvers, tries to maximize this error while being penalized for its energy. The solution, which is obtained by completing the cost function to squares, is shown to satisfy also the matrix version of the maximum principle. The solution is derived in terms of two coupled Riccati difference equations from which the filter gains are derived. In the case where an infinite penalty is imposed on the energy of the exogenous disturbance, the celebrated discrete-time Kalman filter is recovered. A local iterations scheme which is based on linear matrix inequalities is proposed to solve these equations. An illustrative example is given where the velocity of a maneuvering target has to be estimated utilizing noisy measurements of the target position.     

Adaptive cubature Kalman filter with the estimation of correlation between multiplicative noise and additive measurement noise

Mobile robots are often subject to multiplicative noise in the target tracking tasks, where the multiplicative measurement noise is correlated with additive measurement noise. In this paper,first, a correlation multiplicative measurement noise model is established. It is able to more accurately represent the measurement error caused by the distance sensor dependence state. Then, the estimated performance mismatch problem of Cubature Kalman Filter(CKF) under multiplicative noise is analyzed. An i...     

Sensitivity Analysis of Finite-Lag Receivers

This paper presents the sensitivity analysis of a class of receivers called finite-lag receivers, introduced by the authors in [1] through [3]. Since these receivers are based on the use of fixed-lag smoothing techniques, algorithms for the calculation of large-scale and small-scale sensitivities of fixed-lag smoothing are derived using a state augmentation approach. Steady-state analysis of these algorithms shows that an explicit relation can be obtained between sensitivity coefficients of fixed-lag smoothing and filtering. The specific case of sensitivity to variations in the measurement (channel) noise is considered as an example. These results are applied to study the sensitivity performance of the finite-lag receivers for analog communication. It is shown, for example, that finite-lag receivers for AM signals, besides being superior in performance [1]-[3], [11], in terms of output SNR or error variance, are also much less sensitive to the additive noise power level, compared to zero-lag receivers.     

Data fusion of decentralized local tracker outputs

An approach for fusing offboard track-level data at a central fusion node is presented. The case where the offboard tracker continues to update its local track estimate with measurement and system dynamics models that are not necessarily linear is considered. An algorithm is developed to perform this fusion at a central node without having access to the offboard measurements, their noise statistics, or the location of the local estimator. The algorithm is based on an extension of results that were originally established for linear offboard trackers. A second goal of this work is to develop an inequality constraint for selecting the proper sampling interval for the incoming state estimates to the fusion node. This interval is selected to allow use of conventional Kalman filter algorithms at the fusion node without suffering error performance degradation due to processing a correlated sequence of track state estimates     

Trajectory Estimation with Multi-range-rate System Based on Sparse Representation and Spline Model Optimization

The classic state methods for trajectory estimation in boost phase with multi-range-rate system include method of point-by-point manner and that of spline-model-based manner. Both are deficient in terms of model-approximation accuracy and systematic error determination thus resulting in the estimation errors well beyond the requirements, especially, concerning the maneuvering trajectory. This article proposes a new high-precision estimation approach based on the residual error analysis. The residual error comprises three components, i. e. systematic error, model truncation error and random error. The approach realizes self-adaptive estimation of systematic errors in measurements following the theory of sparse representation of signals to minimize the low-frequency components of residual errors. By taking median- and high-frequency components as indexes, the spline model-approximation is improved by optimizing node sequence of the spline function and the weight selection for data fusion through iteration. Simulation has validated the performances of the proposed method.     

Joint parameter and state estimation for stochastic uncertain system with multivariate skew t noises

Due to the pulse interference, measurement outliers and artificial modeling errors, the multivariate skew t noise widely exists in the real environment. However, to date, little attention has been paid to the state estimation for systems in which the process noise and the measurement noise are both modeled as the heavy-tailed and skew non-Gaussian noise. In this paper, the multivariate skew t distribution is utilized to model the heavy-tailed and skew non-Gaussian noise. Then a probabilistic gra...     

受地效影响飞机起飞着陆运动模型的参数辨识

利用基于最小模型误差法和线性不连续跳跃多重打靶法建立的非线性辨识法，辨识了飞机起飞着陆过程的非线性动态模型。对于包含复杂非线性项的动态系统，本方法可以从实际试验测量的系统非线性数据，确定飞机处于地面效应影响运动过程的系统模型，而不需要预先详细描述系统的非线性形式。算例表明该方法对于原始近似动态系统的状态估计是足够精确的。     

Quadratic extended Kalman filter approach for GPS/INS integration

GPS/INS integration system has been widely applied for navigation due to their complementary characteristics. And the tightly coupled integration approach has the advantage over the loosely coupled approach by using the raw GPS measurements, but hence introduces the nonlinearity into the measurement equation of the Kalman filter. So the typical method for navigation using measurements of range or pseudorange is by linearizing the measurements in an extended Kalman filter (EKF). However, the modeling errors of the EKF will cause the bias and divergence problems especially under the situation that the low quality inertial devices are included. To solve this problem, a quadratic EKF approach by adding the second-order derivative information to retain some nonlinearities is proposed in this paper. Simulation results indicate that the nonlinear terms included in the filtering process have the great influence on the performance of integration, especially in the case that the low quality INS is used in the integrated system. Furthermore, a two-stage cascaded estimation method is used, which circumvents the difficulty of solving nonlinear equations and greatly decreases the computational complexity of the proposed approach, so the quadratic EKF approach proposed in this paper is of great value in practice.     

Effect of bias on bearing-only target location

The influence of angle measurement bias on passive target location estimation is investigated. First the conditions for target observability are found and generalized to the non-zero-mean measurement noise case. Then the Cramer-Rao lower bound on the estimation error is derived. Numerical examples are included, illustrating the target location uncertainty in the presence of measurement bias     

涡扇发动机变参数鲁棒H_∞滤波器设计

针对存在建模误差及测量噪声干扰条件下的涡扇发动机性能参数估计问题,标准卡尔曼滤波及其改进算法滤波估计误差收敛速度慢,滤波估计精度低,对不确定测量噪声及建模误差较为敏感,为此本文提出了一种变参数鲁棒H_∞滤波器设计方法。该方法采用仿射参数依赖Lyapunov函数设计满足H_∞性能指标要求的鲁棒滤波器,通过引入凸多胞技术,将参数依赖线性矩阵不等式(Linear Matrix Inequality,LMI)中变参数Lyapunov矩阵与系统系数矩阵之间耦合乘积导致的非凸优化问题,转化为常规LMI约束下的凸优化问题进行求解,降低了线性变参数(Linear Parameter Varying,LPV)鲁棒滤波器设计的保守性,得到了全局解。针对涡扇发动机的仿真结果表明:与扩展卡尔曼滤波器对比,采用该方法设计的滤波器具有较快的动态跟踪速度和较高的滤波精度,ΔFn的稳态估计误差不大于0.1%,ΔFn的相对估计误差不大于2.5%,同时对建模误差和测量噪声干扰具有较强的抑制能力。     

噪声协方差估计新算法在惯性导航系统中的仿真研究

研究一种在动态系统常值误差未知的情况下对线性时变随机系统误差协方差进行估计的新方法。该方法通过构造一个新的时间序列,其协方差由未知参数的线性组合组成,然后用递推最小二乘法来计算新序列的协方差,该方法不需要任何关于噪声的先验知识。从仿真结果来看达到了较好的效果。     

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.     

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.     

Model-based robust estimation and fault detection for MEMS-INS/GPS integrated navigation systems

In micro-electro-mechanical system based inertial navigation system（MEMS-INS）/global position system（GPS） integrated navigation systems, there exist unknown disturbances and abnormal measurements. In order to obtain high estimation accuracy and enhance detection sensitivity to faults in measurements, this paper deals with the problem of model-based robust estimation（RE） and fault detection（FD）. A filter gain matrix and a post-filter are designed to obtain a RE and FD algorithm with current measurements, which is different from most of the existing priori filters using measurements in one-step delay. With the designed filter gain matrix, the H-infinity norm of the transfer function from noise inputs to estimation error outputs is limited within a certain range; with the designed post-filter, the residual signal is robust to disturbances but sensitive to faults. Therefore, the algorithm can guarantee small estimation errors in the presence of disturbances and have high sensitivity to faults. The proposed method is evaluated in an integrated navigation system, and the simulation results show that it is more effective in position estimation and fault signal detection than priori RE and FD algorithms.