UGHF for acoustic tracking with state-dependent propagation delay

Acoustic tracking with propagation delay is a challenging problem for the following reasons: It is difficult to perform an accurate state prediction, as the time interval between the current state and the previous state is varying and unknown due to the propagation delay; and the target time (signal emission time) needs to be estimated in addition to the target position and velocity. With the state augmented with the target time, the state transition cannot be described by the commonly used explicit Gauss-Markov model. In this paper, we propose a new approach to solving this difficult problem by using the Gauss-Helmert model for the state transition, which consists of an implicit equation between two consecutive states. An unscented Gauss-Helmert filter is then developed based on this formulation. The new approach is applied to the bearings-only tracking problem with state-dependent propagation delay. Simulation tests are conducted to demonstrate the performance of the unscented Gauss-Helmert filter, which is shown to outperform other approaches in terms of estimation accuracy, especially when a target is moving at high speed.

[1]  Edward M. Mikhail,et al.  Observations And Least Squares , 1983 .

[2]  Kenichi Kanatani,et al.  Optimal computation of 3-D similarity: Gauss-Newton vs. Gauss-Helmert , 2012, Comput. Stat. Data Anal..

[3]  Fredrik Gustafsson,et al.  Particle filtering with propagation delayed measurements , 2010, 2010 IEEE Aerospace Conference.

[4]  S. Särkkä,et al.  On Unscented Kalman Filtering for State Estimation of Continuous-Time Nonlinear Systems , 2007, IEEE Transactions on Automatic Control.

[5]  Yaakov Bar-Shalom,et al.  A note on "book review tracking and data fusion: A handbook of algorithms" [Authors' reply] , 2013 .

[6]  Fredrik Gustafsson,et al.  Target Tracking With Particle Filters Under Signal Propagation Delays , 2011, IEEE Transactions on Signal Processing.

[7]  Wolfgang Förstner,et al.  On Weighting and Choosing Constraints for Optimally Reconstructing the Geometry of Image Triplets , 2000, ECCV.

[8]  F. Neitzel Generalization of total least-squares on example of unweighted and weighted 2D similarity transformation , 2010 .

[9]  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..

[10]  A. Payne Observability problem for bearings-only tracking , 1989 .

[11]  Fredrik Gustafsson,et al.  Distributed target tracking with propagation delayed measurements , 2009, 2009 12th International Conference on Information Fusion.

[12]  John E. Dennis,et al.  Numerical methods for unconstrained optimization and nonlinear equations , 1983, Prentice Hall series in computational mathematics.

[13]  J. Le Cadre,et al.  Discrete-time observability and estimability analysis for bearings-only target motion analysis , 1997, IEEE Transactions on Aerospace and Electronic Systems.

[14]  Gerald Sommer,et al.  Geometry and Kinematics with Uncertain Data , 2006, ECCV.

[15]  Fredrik Gustafsson,et al.  Target tracking using delayed measurements with implicit constraints , 2008, 2008 11th International Conference on Information Fusion.

[16]  Gee Wah Ng,et al.  Deghosting in multipassive acoustic sensors , 2004, SPIE Defense + Commercial Sensing.

[17]  Thia Kirubarajan,et al.  Estimation with Applications to Tracking and Navigation: Theory, Algorithms and Software , 2001 .

[18]  K. Gong,et al.  Position and Velocity Estimation Via Bearing Observations , 1978, IEEE Transactions on Aerospace and Electronic Systems.

[19]  Burkhard Schaffrin,et al.  Total Least-Squares regularization of Tykhonov type and an ancient racetrack in Corinth , 2010 .

[20]  V. Aidala Kalman Filter Behavior in Bearings-Only Tracking Applications , 1979, IEEE Transactions on Aerospace and Electronic Systems.

[21]  Jeffrey K. Uhlmann,et al.  New extension of the Kalman filter to nonlinear systems , 1997, Defense, Security, and Sensing.

[22]  P. Perona,et al.  Motion estimation via dynamic vision , 1994, Proceedings of 1994 33rd IEEE Conference on Decision and Control.

[23]  Reinhard Koch,et al.  Statistical Analysis of Kalman Filters by Conversion to Gauss-Helmert Models with Applications to Process Noise Estimation , 2010, 2010 20th International Conference on Pattern Recognition.

[24]  Simon Haykin,et al.  Cubature Kalman Filtering for Continuous-Discrete Systems: Theory and Simulations , 2010, IEEE Transactions on Signal Processing.