The Role of Pseudo Measurements in Equality-Constrained State Estimation

The pseudo measurement method is a main approach to equality-constrained state estimation due to its simplicity. It is, however, not popular due to possible numerical problems and increased computational complexity. The work presented here further develops the pseudo measurement method. To avoid numerical problems resulting from singular measurement noise when a matrix inverse is used, the Moore-Penrose (MP) inverse is used instead. Also, to reduce the computational load without performance loss and to simplify the analysis of this type of estimation problem, two sequential forms are obtained. They differ only in the processing order of the physical measurement and the pseudo measurement (i.e., the equality constraint). Although form 1 is the same as some existing results, form 2 is new. This motivates the discussion of processing order for this type of estimation problem, especially in the extension to the nonlinear case. It is found that under certain conditions, the use of the pseudo measurement for filtering is redundant. This differs in effect from update by the physically error-free measurement. However, if there exists model mismatch, update by the pseudo measurement is necessary and helpful. Supporting numerical examples are provided.

[1]  R. Sea,et al.  Increasing the computational efficiency of discrete Kalman filters , 1971 .

[2]  X. Rong Li,et al.  Measure of nonlinearity for stochastic systems , 2012, 2012 15th International Conference on Information Fusion.

[3]  R. Gazit,et al.  Digital tracking filters with high order correlated measurement noise , 1997, IEEE Transactions on Aerospace and Electronic Systems.

[4]  David B. Harris.  Recursive least squares with linear constraints , 1981, ICASSP.

[5]  Frank O'Brien,et al.  Adaptive filtering in underwater tracking with correlated measurement noise , 1993, 1993 IEEE International Conference on Acoustics, Speech, and Signal Processing.

[6]  Wen-Rong Wu,et al.  Maneuvering target tracking with colored noise , 1996 .

[7]  Zhansheng Duan.  Sequential Nonlinear Tracking Filter with Range-rate Measurements in Spherical Coordinates , 2004 .

[8]  C. Yang,et al.  Nonlinear constrained tracking of targets on roads , 2005, 2005 7th International Conference on Information Fusion.

[9]  Vesselin P. Jilkov,et al.  A survey of maneuvering target tracking: approximation techniques for nonlinear filtering , 2004, SPIE Defense + Commercial Sensing.

[10]  N. Gupta,et al.  Kalman Filtering in the Presence of State Space Equality Constraints , 2006, 2007 Chinese Control Conference.

[11]  Yuh-tai Ju,et al.  A duality principle for state estimation with partially noise corrupted measurements , 1981, 1981 20th IEEE Conference on Decision and Control including the Symposium on Adaptive Processes.

[12]  X. Rong Li,et al.  Recursibility and optimal linear estimation and filtering , 2004, CDC.

[13]  M. S. Arulampalam,et al.  Differential geometry measures of nonlinearity for the bearing-only tracking problem , 2005, SPIE Defense + Commercial Sensing.

[14]  Robert R. Bitmead,et al.  State estimation for linear systems with state equality constraints , 2007, Autom..

[15]  Chongzhao Han,et al.  Sequential unscented Kalman filter for radar target tracking with range rate measurements , 2005, 2005 7th International Conference on Information Fusion.

[16]  Dennis S. Bernstein,et al.  State estimation for equality-constrained linear systems , 2007, 2007 46th IEEE Conference on Decision and Control.

[17]  Jie Zhou,et al.  The Linear Minimum Mean-Square Error Estimation with Constraints and Its Applications , 2006, 2006 International Conference on Computational Intelligence and Security.

[18]  Chongzhao Han,et al.  Optimal Linear Estimation Fusion — Part I : Unified Fusion Rules , 2001 .

[19]  D. Bernstein,et al.  Compartmental modelling and second-moment analysis of state space systems , 1993 .

[20]  Zhansheng Duan,et al.  Design and analysis of linear equality constrained dynamic systems , 2012, 2012 15th International Conference on Information Fusion.

[21]  F. Chang,et al.  Filtering method for nonlinear systems with constraints , 2002 .

[22]  Joseph J. LaViola,et al.  On Kalman Filtering With Nonlinear Equality Constraints , 2007, IEEE Transactions on Signal Processing.

[23]  M. Mallick,et al.  Differential Geometry Measures of Nonlinearity with Applications to Ground Target Tracking , 2004 .

[24]  D. Simon,et al.  Kalman filtering with state equality constraints , 2002 .

[25]  Che-Ho Wei,et al.  Maneuvering target tracking using IMM method at high measurement frequency , 1991 .

[26]  LI X.RONG,et al.  Best linear unbiased filtering with nonlinear measurements for target tracking , 2004, IEEE Transactions on Aerospace and Electronic Systems.

[27]  S. Rogers.  Alpha-Beta Filter with Correlated Measurement Noise , 1987, IEEE Transactions on Aerospace and Electronic Systems.

[28]  Chongzhao Han,et al.  Optimal linear estimation fusion .I. Unified fusion rules , 2003, IEEE Trans. Inf. Theory.

[29]  Niels Kjølstad Poulsen,et al.  New developments in state estimation for nonlinear systems , 2000, Autom..

[30]  W. Blair,et al.  Use of a kinematic constraint in tracking constant speed, maneuvering targets , 1993, IEEE Trans. Autom. Control..

[31]  Erik Blasch,et al.  Fusion of Tracks with Road Constraints , 2008, J. Adv. Inf. Fusion.

[32]  F. Markley,et al.  Unscented Filtering for Spacecraft Attitude Estimation , 2003 .

[33]  Yunmin Zhu,et al.  Recursive Least Squares with Linear Constraints , 2007, Commun. Inf. Syst..

[34]  Chien-Shu Hsieh,et al.  Optimal minimal-order least-squares estimators via the general two-stage Kalman filter , 2001, IEEE Trans. Autom. Control..

[35]  Kazufumi Ito,et al.  Gaussian filters for nonlinear filtering problems , 2000, IEEE Trans. Autom. Control..

[36]  Hugh F. Durrant-Whyte,et al.  A new method for the nonlinear transformation of means and covariances in filters and estimators , 2000, IEEE Trans. Autom. Control..

[37]  Zhansheng Duan,et al.  Lossless Linear Transformation of Sensor Data for Distributed Estimation Fusion , 2011, IEEE Transactions on Signal Processing.

[38]  John O'reilly,et al.  Comments on two recent papers on reduced-order optimal state estimation for linear systems with partially noise corrupted measurement , 1982 .

[39]  Michael T. Heath,et al.  A Robust Null Space Method for Linear Equality Constrained State Estimation , 2010, IEEE Transactions on Signal Processing.

[40]  Krishna R. Pattipati,et al.  Ground target tracking with variable structure IMM estimator , 2000, IEEE Trans. Aerosp. Electron. Syst..

[41]  Chun Yang,et al.  Kalman Filtering with Nonlinear State Constraints , 2009 .

[42]  E. Fogel,et al.  Reduced-order optimal state estimator for linear systems with partially noise corrupted measurement , 1980 .