SQUARE-ROOT CUBATURE-QUADRATURE KALMAN FILTER

Size: px
Start display at page:

Download "SQUARE-ROOT CUBATURE-QUADRATURE KALMAN FILTER"

Transcription

1 Asian Journal of Control, Vol. 6, No. 2, pp , March 204 Published online 8 April 203 in Wiley Online Library (wileyonlinelibrary.com) DOI: 0.002/asjc.704 SQUARE-ROO CUBAURE-QUADRAURE KALMAN FILER Shovan Bhaumi and Swati Brief Paper ABSRAC In this paper, an on-going wor introducing square-root extension of cubature-quadrature based Kalman filter is reported. he proposed method is named square-root cubature-quadrature Kalman filter (SR-CQKF). Unlie ordinary cubature-quadrature Kalman filter (CQKF), the proposed method propagates and updates square-root of the error covariance without performing Cholesy decomposition at each step. Moreover SR-CQKF ensures positive semi-definiteness of the state covariance matrix. With the help of two examples we show the superior performance of SR-CQKF compared to and square root cubature Kalman filter. Key Words: Kalman filter, Gauss quadrature rule, square-root filter, nonlinear estimation. I. INRODUCION Many researchers have devoted their best efforts to develop computationally affordable efficient algorithm for nonlinear estimation because it is essential in many real-life problems. Until recently, the extended Kalman filter () has been the natural choice of practitioners for solving nonlinear problems. he uses first order linearization to approximately calculate the mean and covariance of non Gaussian probability density function. Due to such crude approximation, the filter looses trac if the nonlinearity or uncertainty in the system is high. Limitations of for severely nonlinear problems are well documented in earlier literature [,2]. o alleviate the problem, in [3] we proposed a technique named cubature-quadrature Kalman filter (CQKF). CQKF is based on spherical cubature and Gauss-Laguerre quadrature rule of numerical integration. he proposed technique is a more generalized form of cubature Kalman filter (CKF) [4], (which we here call CQKF-) and under single Gauss-Laguerre quadrature point approximation it merges with CKF. In CQKF, it is necessary to perform Cholesy decomposition at each step. Due to accumulated round off error associated with processing software, Cholesy decomposition sometimes leads to negative definite covariance matrices, causing the filter to stop. Unscented Kalman filter (UKF) [5] and Gauss Hermite filter (GHF) also suffer from similar type of hitch which has been rectified by Merwe et al. [6], and Arasaratnam et al. [7], by proposing square-root formulation. In [7], Arasaratnam and Heyin proposed a square root version of the Gauss-Hermite filter algorithm which uses the Gauss-Hermite quadrature method to evaluate intractable integrals. In the present paper, we propose the square root version of cubature quadrature filter which uses third order cubature and Gauss-Laguerre quadrature Manuscript received June 3, 202; revised October 5, 202; accepted November 4, 202. he authors are with Department of Electrical Engineering, Indian Institute of echnology Patna, Bihar-80003, India Dr Shovan Bhaumi is the corresponding author ( shovan.bhaumi@ iitp.ac.in). rule to evaluate the integrals. he methodology adopted here to estimate the states of a nonlinear system is totally different from [7], whereas the square root method we formulate is similar to [6] and [7]. he square-root version of UKF is now being applied to practical problems [8,9] for enhanced computational stability. Motivated by earlier wors [6,7] and their usefulness, we propose the square-root version of CQKF (SR-CQKF) which enhances numerical stability by ensuring positive semi-definiteness of the error covariance matrix. Unlie the CQKF, where Cholesy decomposition, computationally the most expensive operation, has to be performed at each step, the SR-CQKF propagates the state estimate and its square-root covariance. With the help of the examples, we show that SR-CQKF outperforms and. he rest of the paper is organized as follows. he next section provides the brief description of CQKF algorithm. his is followed by elaborate algorithm of SR-CQKF. Finally simulation results, and concluding remars are given in Section 4 and 5 respectively. II. CUBAURE-QUADRAURE KALMAN FILER We developed a novel algorithm [3] where the multivariate moment integral has been computed numerically using cubature rule and multiple Gauss-Laguerre quadrature points. he algorithm has been named the cubature-quadrature Kalman filter. In this section, we briefly describe the algorithm. For detailed derivation readers are referred to [3]. Let us consider a nonlinear plant described by the state and measurement equations as follows: x+ = φ( x) + η () y = γ ( x ) + v (2) where x R n denotes the state of the system, y R p is the measurement at the instant where = {0,, 2, 3,... N},f(x ) 203 Chinese Automatic Control Society and Wiley Publishing Asia Pty Ltd

2 68 Asian Journal of Control, Vol. 6, No. 2, pp , March 204 and g (x ) are nown nonlinear functions of x and. he process noise h R n and measurement noise v R p are assumed to be uncorrelated and normally distributed with covariance Q and R respectively. CQKF approximately evaluates the intractable integrals encountered in Baysian filtering framewor using cubaturequadrature points and corresponding weights associated with them. For n dimensional problem solved with third order spherical cubature and n order of quadrature rule, total number of points and associated weights need to be calculated. he algorithm of the cubature-quadrature Kalman filter (CQKF) could be summarized as follows: Step i. Filter initialization. Initialize the filter with xˆ 00 and P 0 0. Calculate the cubature-quadrature (CQ) points x j and their corresponding weights w j( j =, 2,..., ). Step ii. Predictor step. Perform Cholesy decomposition of posterior error covariance P = S S (3) = S ξ + xˆ (4) j, j Update cubature-quadrature points φ( ) (5) j, + = j, Compute time updated mean and covariance ˆx = w (6) + j j, + + j[ j, + + ] j, + + [ ] + P = w xˆ xˆ Q (7) Step iii. Corrector step or measurement update. Perform Cholesy decomposition of prior error covariance P = S S (8) = S ξ + xˆ (9) j, + + j + where j =,2,.... Find the predicted measurements at each cubaturequadrature points Y j, + = j, + γ( ) (0) Estimate the predicted measurement ŷ = w Y, () + j j + Calculate the covariances [ ] + Py y = wj Yj y Yj y R + +, + ˆ +, + ˆ + (2) [ ] Px y = wj j x Yj y + +, + ˆ +, + ˆ + (3) Calculate Kalman gain K P P [ ][ ] + = x+ y+ y+ y (4) + Compute posterior state values xˆ+ + = xˆ+ + K+ ( y+ yˆ+ ) (5) Posterior error covariance matrix is given by P+ + = P+ K+ Py y K (6) III. SQUARE-ROO CUBAURE-QUADRAURE KALMAN FILER he SR-CQKF is an algebraic re-formulation of CQKF algorithm, where Cholesy decomposition need not to be performed at each step. Due to limited word length in processing software, round off error accumulates and after some iterations the positive semi-definite nature of the error covariance matrix may be lost. o circumvent the problem, in this section, we re-formulate the CQKF algorithm based on orthogonal-triangular decomposition, popularly nown as QR decomposition. he error covariance matrix, P can be factorized as, P = AA (7) where P R n n, and A R n m with m n. Due to increased dimension of A, Arasaratnam and Hayin [7] called it as fat matrix. he QR decomposition of matrix A is given by, A = QR where Q R m m is orthogonal, and R R m n is upper triangular. With the QR decomposition described above, the error covariance matrix can be written as P = AA = R Q QR= R R = SS (8) R is the upper triangular part of R matrix, n n R R, where R = S. he detailed algorithm of square-root cubature-quadrature Kalman filter is provided below. We use the notation qr{} to denote the QR decomposition of a matrix and uptri{} to select the upper triangular part of a matrix. 203 Chinese Automatic Control Society and Wiley Publishing Asia Pty Ltd

3 S. Bhaumi and Swati: Square-Root Cubature-Quadrature Kalman Filter 69 Step i. Filter initialization. Initialize the filter with xˆ 00 and P00 = S00 S00 Calculate the cubature-quadrature (CQ) points x j and their corresponding weights w j (j =, 2,..., ). he methodology to calculate n order cubature quadrature points and associated weights has been described in paper [3]. Step ii. Predictor step. = S ξ + xˆ (9) j, j Update cubature-quadrature points φ( ) (20) j, + = j, Compute time updated mean ˆx = w (2) + j j, + Evaluate square-root weight matrix W = w 0 0 w2 nn (22) Calculate the matrix of square-root weighted cubature-quadrature points after prior mean subtraction [ ] * = xˆ xˆ xˆ W +, + + 2, + +, + + Perform QR decomposition { } (23) R = + qr * + Q (24) Estimate the square-root of predicted error covariance S = uptri{ R } (25) + + Step iii. Measurement update. = S ξ + xˆ (26) j, + + j + Find the predicted measurements at each CQ points Y j, + = j, + γ( ) (27) Estimate the predicted measurement ŷ = w Y, (28) + j j + Calculate the square-root weighted measurement matrix [ ] Y* = Y yˆ Y yˆ Y yˆ W +, + + 2, + +, + + Perform QR decomposition { } (29) R = y + y qr Y * + + R (30) Calculate the square root of innovation covariance S = uptri{ R } (3) y+ y+ y+ y+ Calculate the cross covariance matrix P * Y* (32) x y = Calculate Kalman gain K P S S = ( ) x y y y y y (33) Compute posterior state values xˆ+ + = xˆ+ + K( y+ yˆ+ ) (34) Calculate QR decomposition { } R = + + qr * + KY * + Q K R (35) Calculate square root of posterior error covariance matrix S = uptri{ R } (36) Note. he equation (35) can be derived from equations (4), (6), (24), (30), and (32) by matrix manipulation. For detailed steps readers are refered to [7]. Note 2. he practitioners who want to implement the algorithm in MALAB software environment, should note that the command chol (P) returns the matrix S (where P = SS ) rather than S. Accordingly the expressions for next steps need to be evaluated. IV. SIMULAION RESULS In this section, the formulated algorithm described above has been applied to solve a single dimensional as well as multi dimensional nonlinear problem. Example. Single dimensional process. he plant model, inspired by [0], has one unstable and two stable equilibrium points and given by x+ = φ( x) + η 2 2 φ( x) = x+ Δt5x( x ), η ~ ℵ( 0, b Δt) 203 Chinese Automatic Control Society and Wiley Publishing Asia Pty Ltd

4 620 Asian Journal of Control, Vol. 6, No. 2, pp , March 204 he measurement model is y = γ ( x ) + v 2 γ ( x) = Δtx( 0. 5x), v ~ ℵ( 0, d Δt) and the value of Dt = 0.0 seconds, x 0 =-0.2, xˆ 00 = 08., P 0 0 = 2, b = 0.5 and d = 0.. We have considered the time span from 0 to 4 seconds. he system has three equilibrium points, of which, the one at the origin is unstable and the other two are at and stable. In the absence of any bias, the system settles around either of the two stable equilibrium points. he problem becomes challenging because moderate estimation error forces the estimate to settle down at the wrong equilibrium point, leading to a trac loss situation. We solve the estimation problem using and SR-CQKF. he percentage fail counts for different filters are shown in able I. he percentage fail count is defined as the number of cases where estimation error at 4th second is more than unity out of 00 Monte Carlo runs. In our notation, CQKF-x indicates an x order Gauss-Laguerre cubature-quadrature filter. Under the first order Gauss-Laguerre approximation CQKF reduces to CKF. he numbers mentioned in the table show the improvement of performance with the square-root CQKF. able I. Percentage fail count. Filter Fail Count 22% or SR-CQKF- 4%.05%.02%.02% Fig. shows the root mean square error () obtained from SR-CQKF and out of 0,000 Monte Carlo runs. It can be seen from Fig., that of higher order SR-CQKF converges more quicly than first order SR-CQKF or. However no significant improvement of performance is noticed with more than second order SR-CQKF. Example 2. Lorenz system. Inspired from earlier wors [0,], in this example, we consider the discrete time Lorenz attractor, one of the classic icons in nonlinear dynamics. he attractor is available in the literature from 963, mainly due to the wor of meteorologist Edward Lorenz. Although a higher dimensional Lorenz attractor may exists [2,3] in real life problems, here we consider three dimensional system. he process equation is given by x+ = φ( x) + bη φ( x) = x+ Δtf( x), η ~ ℵ( 0, Δt) he measurement equation is expressed as y = γ ( x ) + dv γ ( x) = Δth( x), v ~ ℵ( 0, Δt) Here x = [x, x 2, x 3,] R 3 is state variable. he parameters b R 3, and d R are constant whose values are taen as b = [ ] and d = he functions f(x) and h(x) are given by [ ] f( x) = α( x + x ) βx x x x γx + x x ime (s) Fig.. plot of SR-CQKF with higher order Gauss-Laguerre quadrature points. 203 Chinese Automatic Control Society and Wiley Publishing Asia Pty Ltd

5 S. Bhaumi and Swati: Square-Root Cubature-Quadrature Kalman Filter 62 able II. Average root mean square error over time span. Filter Averaged Averaged Averaged (State ) (State 2) (State 3) or SR-CQKF and ime (sec) Fig. 2. plot of and SR-CQKF for first state variable. h( x)= x 2 + x2 2 + x3 2 he three parameters, a (called the Prandtl number), b (called the Rayleigh number), and g have great impact on the system. he system has three unstable equilibrium points and for a 0, and g(b - ) 0 they are at [0 0 0], γ( β ) γ( β ) ( β ), and γ( β ) γ( β ) ( β ). We chose the system with classical parameter values: a = 0, g = 8/3, and b = 28, for which almost all points in phase space tend to a strange attractor [3]. he initial truth value of state is taen as x 0 = [ ]. We simulate during the time interval of 0 to 4 seconds with the sampling time Dt = 0.0 seconds. he initial posterior estimate is assumed as xˆ 00 = [ ] with initial error covariance P 0 0 = 0.35I 3. he above described problem has been solved using square-root version of CQKF with higher order of Gauss-Laguerre approximation. We observe that sometimes ordinary CQKF fails to run due to non positive definite error covariance matrix. he same problem does not occur during SR-CQKF as expected from the formulation. he root mean square error, averaged over time span, obtained from 50 Monte Carlo runs, has been tabulated in able II. In Figs 2 4, we show the root mean square errors (s) of the states obtained from and SR-CQKF. was calculated from 50 Monte Carlo ime (sec) Fig. 3. plot of and SR-CQKF for second state variable ime (sec) Fig. 4. plot of and SR-CQKF for third state variable. runs. he results obtained from the simulation run may be summarized as follows: From Fig. 4, no improvement in estimation of third state variable has been observed with SR-CQKF in comparison with. his is also supported from the numbers displayed in able II. uses first order linearization to approximately calculate the mean and covariance of non Gaussian probability density function. Cubature quadrature Kalman filter uses cubature rule and Gauss-Laguerre quadrature points to 203 Chinese Automatic Control Society and Wiley Publishing Asia Pty Ltd

6 622 Asian Journal of Control, Vol. 6, No. 2, pp , March 204 determine the mean and covariance of posterior probability density function. he moment calculation is more accurate in the second case; hence improvement in performance is expected compared to. he argument is well supported by Figs 2 3, where we notice that for first and second state variable, SR-CQKF- or performs significantly better than. Further for the first and second state variable, performs considerably better than SR-CQKF-. Although from the Figs 2 3 no noticeable improvement is observed with SR-CQKF with the order higher than 2. From able II, it is clear that SR-CQKF provides significantly lower averaged in comparison to. Also the performance of the SR-CQKF improves with the higher order Gauss-Laguerre quadrature approximation. However after the 4th order, SR-CQKF does not offer any improvement, hence it is not displayed in the table. Computational times of SR-CQKF and CQKF have been compared. It has been observed that CQKF- and SR-CQKF- tae 7.83 seconds and 4.9 seconds respectively for 50 MC runs in MALAB software in a personal computer with a 2.40 GHz processor. he result indicates lower computational cost of square root cubature quadrature Kalman filter compared to ordinary CQKF. V. DISCUSSIONS AND CONCLUSION In this paper, the square-root extension of cubaturequadrature Kalman filter has been proposed. In comparison to CQKF, the proposed estimator has better numerical properties and guaranteed positive semi-definiteness of error covariance matrix. Instead of performing Cholesy decomposition at each step, the proposed filter propagates and updates square-root of the error covariance. With the help of examples, the superiority of the proposed algorithm over and is demonstrated. he simulation results also reveal the performance improvement of SR-CQKF with higher order Gauss-Laguerre quadrature approximation. REFERENCES. Julier, S. J. and J. K. Uhlmann, Unscented filtering and nonlinear estimation, Proceedings of the IEEE, Vol. 92, No. 3, (2004). 2. Luca, M., S. Azou, G. Burel, and A. Serbanescu, On exact Kalman filtering of polynomial systems, IEEE rans. Circuits Syst. Regul. Pap., Vol. 53, No. 6, pp (2006). 3. Swati and S. Bhaumi, Non linear estimation using cubature quadrature points, Proc. IEEE International Conference on Energy, Automation and Signal, Bhubaneswar, India, Dec (20). 4. Arasaratnam, I. and S. Hayin, Cubature Kalman filters, IEEE rans. Autom. Control, Vol. 54, No. 6, (2009). 5. Julier, S., J. Uhlmann, and D. Whyte, A new method for the nonlinear transformation of means and covariances in filters and estimators, IEEE rans. Autom. Control, Vol. 45, No. 3, pp (2000). 6. Van der Merwe, R. and E. A. Wan, he square-root unscented Kalman filter for state and parameter-estimation, Proc. of IEEE International Conference on Acoustics, Speech, and Signal Processing, Vol. 6, pp (200). 7. Arasaratnam, I. and S. Hayin, Square-root quadrature Kalman filtering, IEEE rans. Signal Process., Vol. 56, No. 6, pp (2008). 8. ang, Xiaojun, Jie Yan, and Dudu Zhong. Square-root sigma-point Kalman filtering for spacecraft relative navigation, Acta Astronaut., Vol 66, pp (200). 9. Soen, H. E. and C. Hajiyev, UKF based In-flight calibration of magnetometers and rate gyros for pico satellite attitude determination, Asian J. Control, Vol. 4, No. 3, pp (202). 0. Ito, K. and K. Xiong, Gaussian filters for nonlinear filtering problems, IEEE rans. Autom. Control, Vol. 45, No. 5, pp (2000).. erejanu, G., P. Singla,. Singh, and P. D. Scott, Adaptive gaussian sum filter for nonlinear bayesian estimation, IEEE rans. Autom. Control, Vol. 56, No.9, pp (20). 2. Stewart, I., he lorenz attractor exists, Nature, Vol. 406, pp (2000). 3. ucer, W. he lorentz attractor exists, C.R. Acad. Sci. Paris Ser. I Math., Vol. 328, No. 2, pp (999). 203 Chinese Automatic Control Society and Wiley Publishing Asia Pty Ltd

A New Nonlinear Filtering Method for Ballistic Target Tracking

A New Nonlinear Filtering Method for Ballistic Target Tracking th International Conference on Information Fusion Seattle, WA, USA, July 6-9, 9 A New Nonlinear Filtering Method for Ballistic arget racing Chunling Wu Institute of Electronic & Information Engineering

More information

ROBUST ENSEMBLE KALMAN FILTER BASED ON EXPONENTIAL COST FUNCTION

ROBUST ENSEMBLE KALMAN FILTER BASED ON EXPONENTIAL COST FUNCTION Asian Journal of Control, Vol. 7, No., pp. 0, January 05 Published online in Wiley Online Library (wileyonlinelibrary.com) DOI: 0.00/asc.843 ROBUS ENSEMBLE KALMAN FILER BASED ON EXPONENIAL COS FUNCION

More information

Extension of the Sparse Grid Quadrature Filter

Extension of the Sparse Grid Quadrature Filter Extension of the Sparse Grid Quadrature Filter Yang Cheng Mississippi State University Mississippi State, MS 39762 Email: cheng@ae.msstate.edu Yang Tian Harbin Institute of Technology Harbin, Heilongjiang

More information

Quadrature Filters for Maneuvering Target Tracking

Quadrature Filters for Maneuvering Target Tracking Quadrature Filters for Maneuvering Target Tracking Abhinoy Kumar Singh Department of Electrical Engineering, Indian Institute of Technology Patna, Bihar 813, India, Email: abhinoy@iitpacin Shovan Bhaumik

More information

SIGMA POINT GAUSSIAN SUM FILTER DESIGN USING SQUARE ROOT UNSCENTED FILTERS

SIGMA POINT GAUSSIAN SUM FILTER DESIGN USING SQUARE ROOT UNSCENTED FILTERS SIGMA POINT GAUSSIAN SUM FILTER DESIGN USING SQUARE ROOT UNSCENTED FILTERS Miroslav Šimandl, Jindřich Duní Department of Cybernetics and Research Centre: Data - Algorithms - Decision University of West

More information

RECURSIVE OUTLIER-ROBUST FILTERING AND SMOOTHING FOR NONLINEAR SYSTEMS USING THE MULTIVARIATE STUDENT-T DISTRIBUTION

RECURSIVE OUTLIER-ROBUST FILTERING AND SMOOTHING FOR NONLINEAR SYSTEMS USING THE MULTIVARIATE STUDENT-T DISTRIBUTION 1 IEEE INTERNATIONAL WORKSHOP ON MACHINE LEARNING FOR SIGNAL PROCESSING, SEPT. 3 6, 1, SANTANDER, SPAIN RECURSIVE OUTLIER-ROBUST FILTERING AND SMOOTHING FOR NONLINEAR SYSTEMS USING THE MULTIVARIATE STUDENT-T

More information

Nonlinear State Estimation! Particle, Sigma-Points Filters!

Nonlinear State Estimation! Particle, Sigma-Points Filters! Nonlinear State Estimation! Particle, Sigma-Points Filters! Robert Stengel! Optimal Control and Estimation, MAE 546! Princeton University, 2017!! Particle filter!! Sigma-Points Unscented Kalman ) filter!!

More information

NON-LINEAR NOISE ADAPTIVE KALMAN FILTERING VIA VARIATIONAL BAYES

NON-LINEAR NOISE ADAPTIVE KALMAN FILTERING VIA VARIATIONAL BAYES 2013 IEEE INTERNATIONAL WORKSHOP ON MACHINE LEARNING FOR SIGNAL PROCESSING NON-LINEAR NOISE ADAPTIVE KALMAN FILTERING VIA VARIATIONAL BAYES Simo Särä Aalto University, 02150 Espoo, Finland Jouni Hartiainen

More information

Lecture 2: From Linear Regression to Kalman Filter and Beyond

Lecture 2: From Linear Regression to Kalman Filter and Beyond Lecture 2: From Linear Regression to Kalman Filter and Beyond January 18, 2017 Contents 1 Batch and Recursive Estimation 2 Towards Bayesian Filtering 3 Kalman Filter and Bayesian Filtering and Smoothing

More information

Higher-Degree Stochastic Integration Filtering

Higher-Degree Stochastic Integration Filtering Higher-Degree Stochastic Integration Filtering Syed Safwan Khalid, Naveed Ur Rehman, and Shafayat Abrar Abstract arxiv:1608.00337v1 cs.sy 1 Aug 016 We obtain a class of higher-degree stochastic integration

More information

Lecture 7: Optimal Smoothing

Lecture 7: Optimal Smoothing Department of Biomedical Engineering and Computational Science Aalto University March 17, 2011 Contents 1 What is Optimal Smoothing? 2 Bayesian Optimal Smoothing Equations 3 Rauch-Tung-Striebel Smoother

More information

A Comparison of the EKF, SPKF, and the Bayes Filter for Landmark-Based Localization

A Comparison of the EKF, SPKF, and the Bayes Filter for Landmark-Based Localization A Comparison of the EKF, SPKF, and the Bayes Filter for Landmark-Based Localization and Timothy D. Barfoot CRV 2 Outline Background Objective Experimental Setup Results Discussion Conclusion 2 Outline

More information

A New Nonlinear State Estimator Using the Fusion of Multiple Extended Kalman Filters

A New Nonlinear State Estimator Using the Fusion of Multiple Extended Kalman Filters 18th International Conference on Information Fusion Washington, DC - July 6-9, 2015 A New Nonlinear State Estimator Using the Fusion of Multiple Extended Kalman Filters Zhansheng Duan, Xiaoyun Li Center

More information

Data Assimilation for Dispersion Models

Data Assimilation for Dispersion Models Data Assimilation for Dispersion Models K. V. Umamaheswara Reddy Dept. of Mechanical and Aerospace Engg. State University of New Yor at Buffalo Buffalo, NY, U.S.A. venatar@buffalo.edu Yang Cheng Dept.

More information

Constrained State Estimation Using the Unscented Kalman Filter

Constrained State Estimation Using the Unscented Kalman Filter 16th Mediterranean Conference on Control and Automation Congress Centre, Ajaccio, France June 25-27, 28 Constrained State Estimation Using the Unscented Kalman Filter Rambabu Kandepu, Lars Imsland and

More information

in a Rao-Blackwellised Unscented Kalman Filter

in a Rao-Blackwellised Unscented Kalman Filter A Rao-Blacwellised Unscented Kalman Filter Mar Briers QinetiQ Ltd. Malvern Technology Centre Malvern, UK. m.briers@signal.qinetiq.com Simon R. Masell QinetiQ Ltd. Malvern Technology Centre Malvern, UK.

More information

On Continuous-Discrete Cubature Kalman Filtering

On Continuous-Discrete Cubature Kalman Filtering On Continuous-Discrete Cubature Kalman Filtering Simo Särkkä Arno Solin Aalto University, P.O. Box 12200. FI-00076 AALTO, Finland. (Tel: +358 50 512 4393; e-mail: simo.sarkka@aalto.fi) Aalto University,

More information

Gaussian Filters for Nonlinear Filtering Problems

Gaussian Filters for Nonlinear Filtering Problems 910 IEEE TRANSACTIONS ON AUTOMATIC CONTROL, VOL. 45, NO. 5, MAY 2000 Gaussian Filters for Nonlinear Filtering Problems Kazufumi Ito Kaiqi Xiong Abstract In this paper we develop analyze real-time accurate

More information

Adaptive Cubature Strong Tracking Information Filter Using Variational Bayesian Method

Adaptive Cubature Strong Tracking Information Filter Using Variational Bayesian Method Preprints of the 19th World Congress The International Federation of Automatic Control Adaptive Cubature Strong Tracing Information Filter Using Variational Bayesian Method Quanbo Ge, Chenglin Wen, Shaodong

More information

Information Formulation of the UDU Kalman Filter

Information Formulation of the UDU Kalman Filter Information Formulation of the UDU Kalman Filter Christopher D Souza and Renato Zanetti 1 Abstract A new information formulation of the Kalman filter is presented where the information matrix is parameterized

More information

Comparison of Kalman Filter Estimation Approaches for State Space Models with Nonlinear Measurements

Comparison of Kalman Filter Estimation Approaches for State Space Models with Nonlinear Measurements Comparison of Kalman Filter Estimation Approaches for State Space Models with Nonlinear Measurements Fredri Orderud Sem Sælands vei 7-9, NO-7491 Trondheim Abstract The Etended Kalman Filter (EKF) has long

More information

Adaptive Unscented Kalman Filter with Multiple Fading Factors for Pico Satellite Attitude Estimation

Adaptive Unscented Kalman Filter with Multiple Fading Factors for Pico Satellite Attitude Estimation Adaptive Unscented Kalman Filter with Multiple Fading Factors for Pico Satellite Attitude Estimation Halil Ersin Söken and Chingiz Hajiyev Aeronautics and Astronautics Faculty Istanbul Technical University

More information

MODELLING ANALYSIS & DESIGN OF DSP BASED NOVEL SPEED SENSORLESS VECTOR CONTROLLER FOR INDUCTION MOTOR DRIVE

MODELLING ANALYSIS & DESIGN OF DSP BASED NOVEL SPEED SENSORLESS VECTOR CONTROLLER FOR INDUCTION MOTOR DRIVE International Journal of Advanced Research in Engineering and Technology (IJARET) Volume 6, Issue 3, March, 2015, pp. 70-81, Article ID: IJARET_06_03_008 Available online at http://www.iaeme.com/ijaret/issues.asp?jtypeijaret&vtype=6&itype=3

More information

Mini-Course 07 Kalman Particle Filters. Henrique Massard da Fonseca Cesar Cunha Pacheco Wellington Bettencurte Julio Dutra

Mini-Course 07 Kalman Particle Filters. Henrique Massard da Fonseca Cesar Cunha Pacheco Wellington Bettencurte Julio Dutra Mini-Course 07 Kalman Particle Filters Henrique Massard da Fonseca Cesar Cunha Pacheco Wellington Bettencurte Julio Dutra Agenda State Estimation Problems & Kalman Filter Henrique Massard Steady State

More information

The Unscented Particle Filter

The Unscented Particle Filter The Unscented Particle Filter Rudolph van der Merwe (OGI) Nando de Freitas (UC Bereley) Arnaud Doucet (Cambridge University) Eric Wan (OGI) Outline Optimal Estimation & Filtering Optimal Recursive Bayesian

More information

Lecture 2: From Linear Regression to Kalman Filter and Beyond

Lecture 2: From Linear Regression to Kalman Filter and Beyond Lecture 2: From Linear Regression to Kalman Filter and Beyond Department of Biomedical Engineering and Computational Science Aalto University January 26, 2012 Contents 1 Batch and Recursive Estimation

More information

ROBUST CONSTRAINED ESTIMATION VIA UNSCENTED TRANSFORMATION. Pramod Vachhani a, Shankar Narasimhan b and Raghunathan Rengaswamy a 1

ROBUST CONSTRAINED ESTIMATION VIA UNSCENTED TRANSFORMATION. Pramod Vachhani a, Shankar Narasimhan b and Raghunathan Rengaswamy a 1 ROUST CONSTRINED ESTIMTION VI UNSCENTED TRNSFORMTION Pramod Vachhani a, Shankar Narasimhan b and Raghunathan Rengaswamy a a Department of Chemical Engineering, Clarkson University, Potsdam, NY -3699, US.

More information

EKF, UKF. Pieter Abbeel UC Berkeley EECS. Many slides adapted from Thrun, Burgard and Fox, Probabilistic Robotics

EKF, UKF. Pieter Abbeel UC Berkeley EECS. Many slides adapted from Thrun, Burgard and Fox, Probabilistic Robotics EKF, UKF Pieter Abbeel UC Berkeley EECS Many slides adapted from Thrun, Burgard and Fox, Probabilistic Robotics Kalman Filter Kalman Filter = special case of a Bayes filter with dynamics model and sensory

More information

EKF, UKF. Pieter Abbeel UC Berkeley EECS. Many slides adapted from Thrun, Burgard and Fox, Probabilistic Robotics

EKF, UKF. Pieter Abbeel UC Berkeley EECS. Many slides adapted from Thrun, Burgard and Fox, Probabilistic Robotics EKF, UKF Pieter Abbeel UC Berkeley EECS Many slides adapted from Thrun, Burgard and Fox, Probabilistic Robotics Kalman Filter Kalman Filter = special case of a Bayes filter with dynamics model and sensory

More information

Extended Object and Group Tracking with Elliptic Random Hypersurface Models

Extended Object and Group Tracking with Elliptic Random Hypersurface Models Extended Object and Group Tracing with Elliptic Random Hypersurface Models Marcus Baum Benjamin Noac and Uwe D. Hanebec Intelligent Sensor-Actuator-Systems Laboratory ISAS Institute for Anthropomatics

More information

Recurrent Neural Network Training with the Extended Kalman Filter

Recurrent Neural Network Training with the Extended Kalman Filter Recurrent Neural Networ raining with the Extended Kalman Filter Peter REBAICKÝ Slova University of echnology Faculty of Informatics and Information echnologies Ilovičova 3, 842 16 Bratislava, Slovaia trebaticy@fiit.stuba.s

More information

Application of Unscented Transformation for Nonlinear State Smoothing

Application of Unscented Transformation for Nonlinear State Smoothing Application of Unscented Transformation for Nonlinear State Smoothing WANG Xiao-Xu 1 PAN Quan 1 LIANG Yan 1 ZHAO Chun-Hui 1 Abstract Motivated by the well-known fact that the state estimate of a smoother

More information

Autonomous Mobile Robot Design

Autonomous Mobile Robot Design Autonomous Mobile Robot Design Topic: Extended Kalman Filter Dr. Kostas Alexis (CSE) These slides relied on the lectures from C. Stachniss, J. Sturm and the book Probabilistic Robotics from Thurn et al.

More information

A new unscented Kalman filter with higher order moment-matching

A new unscented Kalman filter with higher order moment-matching A new unscented Kalman filter with higher order moment-matching KSENIA PONOMAREVA, PARESH DATE AND ZIDONG WANG Department of Mathematical Sciences, Brunel University, Uxbridge, UB8 3PH, UK. Abstract This

More information

Cubature Kalman Filters Ienkaran Arasaratnam and Simon Haykin, Life Fellow, IEEE

Cubature Kalman Filters Ienkaran Arasaratnam and Simon Haykin, Life Fellow, IEEE 1254 IEEE TRANSACTIONS ON AUTOMATIC CONTROL, VOL. 54, NO. 6, JUNE 2009 Cubature Kalman Filters Ienkaran Arasaratnam and Simon Haykin, Life Fellow, IEEE Abstract In this paper, we present a new nonlinear

More information

REAL-TIME ATTITUDE-INDEPENDENT THREE-AXIS MAGNETOMETER CALIBRATION

REAL-TIME ATTITUDE-INDEPENDENT THREE-AXIS MAGNETOMETER CALIBRATION REAL-TIME ATTITUDE-INDEPENDENT THREE-AXIS MAGNETOMETER CALIBRATION John L. Crassidis and Ko-Lam Lai Department of Mechanical & Aerospace Engineering University at Buffalo, State University of New Yor Amherst,

More information

Recursive Noise Adaptive Kalman Filtering by Variational Bayesian Approximations

Recursive Noise Adaptive Kalman Filtering by Variational Bayesian Approximations PREPRINT 1 Recursive Noise Adaptive Kalman Filtering by Variational Bayesian Approximations Simo Särä, Member, IEEE and Aapo Nummenmaa Abstract This article considers the application of variational Bayesian

More information

Computers and Chemical Engineering

Computers and Chemical Engineering Computers and Chemical Engineering 33 (2009) 13861401 Contents lists available at ScienceDirect Computers and Chemical Engineering journal homepage: www.elsevier.com/locate/compchemeng Constrained nonlinear

More information

Sigma Point Belief Propagation

Sigma Point Belief Propagation Copyright 2014 IEEE IEEE Signal Processing Letters, vol. 21, no. 2, Feb. 2014, pp. 145 149 1 Sigma Point Belief Propagation Florian Meyer, Student Member, IEEE, Ondrej Hlina, Member, IEEE, and Franz Hlawatsch,

More information

QUATERNION FEEDBACK ATTITUDE CONTROL DESIGN: A NONLINEAR H APPROACH

QUATERNION FEEDBACK ATTITUDE CONTROL DESIGN: A NONLINEAR H APPROACH Asian Journal of Control, Vol. 5, No. 3, pp. 406-4, September 003 406 Brief Paper QUAERNION FEEDBACK AIUDE CONROL DESIGN: A NONLINEAR H APPROACH Long-Life Show, Jyh-Ching Juang, Ying-Wen Jan, and Chen-zung

More information

DATA ASSIMILATION FOR FLOOD FORECASTING

DATA ASSIMILATION FOR FLOOD FORECASTING DATA ASSIMILATION FOR FLOOD FORECASTING Arnold Heemin Delft University of Technology 09/16/14 1 Data assimilation is the incorporation of measurement into a numerical model to improve the model results

More information

UNSCENTED KALMAN FILTERING FOR SPACECRAFT ATTITUDE STATE AND PARAMETER ESTIMATION

UNSCENTED KALMAN FILTERING FOR SPACECRAFT ATTITUDE STATE AND PARAMETER ESTIMATION AAS-04-115 UNSCENTED KALMAN FILTERING FOR SPACECRAFT ATTITUDE STATE AND PARAMETER ESTIMATION Matthew C. VanDyke, Jana L. Schwartz, Christopher D. Hall An Unscented Kalman Filter (UKF) is derived in an

More information

Dynamic System Identification using HDMR-Bayesian Technique

Dynamic System Identification using HDMR-Bayesian Technique Dynamic System Identification using HDMR-Bayesian Technique *Shereena O A 1) and Dr. B N Rao 2) 1), 2) Department of Civil Engineering, IIT Madras, Chennai 600036, Tamil Nadu, India 1) ce14d020@smail.iitm.ac.in

More information

A Gaussian Mixture PHD Filter for Nonlinear Jump Markov Models

A Gaussian Mixture PHD Filter for Nonlinear Jump Markov Models A Gaussian Mixture PHD Filter for Nonlinear Jump Marov Models Ba-Ngu Vo Ahmed Pasha Hoang Duong Tuan Department of Electrical and Electronic Engineering The University of Melbourne Parville VIC 35 Australia

More information

Integrated Navigation System Using Sigma-Point Kalman Filter and Particle Filter

Integrated Navigation System Using Sigma-Point Kalman Filter and Particle Filter Integrated Navigation System Using Sigma-Point Kalman Filter and Particle Filter Dr. Milos Sota and Dr. Milan Sopata and Dr. Stefan Berezny Academy of Armed Forces, Demanova 393, 311 Liptovsy Miulas, Slova

More information

Chaos Suppression in Forced Van Der Pol Oscillator

Chaos Suppression in Forced Van Der Pol Oscillator International Journal of Computer Applications (975 8887) Volume 68 No., April Chaos Suppression in Forced Van Der Pol Oscillator Mchiri Mohamed Syscom laboratory, National School of Engineering of unis

More information

Lecture 6: Bayesian Inference in SDE Models

Lecture 6: Bayesian Inference in SDE Models Lecture 6: Bayesian Inference in SDE Models Bayesian Filtering and Smoothing Point of View Simo Särkkä Aalto University Simo Särkkä (Aalto) Lecture 6: Bayesian Inference in SDEs 1 / 45 Contents 1 SDEs

More information

Using the Kalman Filter to Estimate the State of a Maneuvering Aircraft

Using the Kalman Filter to Estimate the State of a Maneuvering Aircraft 1 Using the Kalman Filter to Estimate the State of a Maneuvering Aircraft K. Meier and A. Desai Abstract Using sensors that only measure the bearing angle and range of an aircraft, a Kalman filter is implemented

More information

Prediction of ESTSP Competition Time Series by Unscented Kalman Filter and RTS Smoother

Prediction of ESTSP Competition Time Series by Unscented Kalman Filter and RTS Smoother Prediction of ESTSP Competition Time Series by Unscented Kalman Filter and RTS Smoother Simo Särkkä, Aki Vehtari and Jouko Lampinen Helsinki University of Technology Department of Electrical and Communications

More information

An Improved Particle Filter with Applications in Ballistic Target Tracking

An Improved Particle Filter with Applications in Ballistic Target Tracking Sensors & ransducers Vol. 72 Issue 6 June 204 pp. 96-20 Sensors & ransducers 204 by IFSA Publishing S. L. http://www.sensorsportal.co An Iproved Particle Filter with Applications in Ballistic arget racing

More information

State Estimation of Linear and Nonlinear Dynamic Systems

State Estimation of Linear and Nonlinear Dynamic Systems State Estimation of Linear and Nonlinear Dynamic Systems Part III: Nonlinear Systems: Extended Kalman Filter (EKF) and Unscented Kalman Filter (UKF) James B. Rawlings and Fernando V. Lima Department of

More information

Recursive LMMSE Filtering for Target Tracking with Range and Direction Cosine Measurements

Recursive LMMSE Filtering for Target Tracking with Range and Direction Cosine Measurements Recursive Filtering for Target Tracing with Range and Direction Cosine Measurements Zhansheng Duan Yu Liu X. Rong Li Department of Electrical Engineering University of New Orleans New Orleans, LA 748,

More information

Nonlinear Estimation Techniques for Impact Point Prediction of Ballistic Targets

Nonlinear Estimation Techniques for Impact Point Prediction of Ballistic Targets Nonlinear Estimation Techniques for Impact Point Prediction of Ballistic Targets J. Clayton Kerce a, George C. Brown a, and David F. Hardiman b a Georgia Tech Research Institute, Georgia Institute of Technology,

More information

Combined Particle and Smooth Variable Structure Filtering for Nonlinear Estimation Problems

Combined Particle and Smooth Variable Structure Filtering for Nonlinear Estimation Problems 14th International Conference on Information Fusion Chicago, Illinois, USA, July 5-8, 2011 Combined Particle and Smooth Variable Structure Filtering for Nonlinear Estimation Problems S. Andrew Gadsden

More information

Nonlinear and/or Non-normal Filtering. Jesús Fernández-Villaverde University of Pennsylvania

Nonlinear and/or Non-normal Filtering. Jesús Fernández-Villaverde University of Pennsylvania Nonlinear and/or Non-normal Filtering Jesús Fernández-Villaverde University of Pennsylvania 1 Motivation Nonlinear and/or non-gaussian filtering, smoothing, and forecasting (NLGF) problems are pervasive

More information

Iterative Diffusion-Based Distributed Cubature Gaussian Mixture Filter for Multisensor Estimation

Iterative Diffusion-Based Distributed Cubature Gaussian Mixture Filter for Multisensor Estimation sensors Article Iterative Diffusion-Based Distributed Cubature Gaussian Mixture Filter for Multisensor Estimation Bin Jia 1, Tao Sun 2 and Ming Xin 2, * 1 Intelligent Fusion Technology, Germantown, MD

More information

Tampere University of Technology. Ala-Luhtala, Juha; Seppänen, Mari; Ali-Löytty, Simo; Piché, Robert; Nurminen, Henri

Tampere University of Technology. Ala-Luhtala, Juha; Seppänen, Mari; Ali-Löytty, Simo; Piché, Robert; Nurminen, Henri Tampere University of Technology Author(s) Title Ala-Luhtala, Juha; Seppänen, Mari; Ali-Löytty, Simo; Piché, Robert; Nurminen, Henri Estimation of initial state and model parameters for autonomous GNSS

More information

Randomized Unscented Kalman Filter in Target Tracking

Randomized Unscented Kalman Filter in Target Tracking Randomized Unscented Kalman Filter in Target Tracking Ondřej Straka, Jindřich Duník and Miroslav Šimandl Department of Cybernetics, Faculty of Applied Sciences, University of West Bohemia, Univerzitní

More information

CONSTRAINT KALMAN FILTER FOR INDOOR BLUETOOTH LOCALIZATION

CONSTRAINT KALMAN FILTER FOR INDOOR BLUETOOTH LOCALIZATION CONSTRAINT KALMAN FILTER FOR INDOOR BLUETOOTH LOCALIZATION Liang Chen, Heidi Kuusniemi, Yuwei Chen, Jingbin Liu, Ling Pei, Laura Ruotsalainen, and Ruizhi Chen NLS Finnish Geospatial Research Institute

More information

Extension of Farrenkopf Steady-State Solutions with Estimated Angular Rate

Extension of Farrenkopf Steady-State Solutions with Estimated Angular Rate Extension of Farrenopf Steady-State Solutions with Estimated Angular Rate Andrew D. Dianetti and John L. Crassidis University at Buffalo, State University of New Yor, Amherst, NY 46-44 Steady-state solutions

More information

A Comparison of Multiple-Model Target Tracking Algorithms

A Comparison of Multiple-Model Target Tracking Algorithms University of New Orleans ScholarWors@UNO University of New Orleans heses and Dissertations Dissertations and heses 1-17-4 A Comparison of Multiple-Model arget racing Algorithms Ryan Pitre University of

More information

Research Article. A Private Secure Communication Scheme Using UKF-based Chaos Synchronization

Research Article. A Private Secure Communication Scheme Using UKF-based Chaos Synchronization Jestr Journal of Engineering Science and echnology Review 8 (2) (2015) 96-105 Special Issue on Synchronization and Control of Chaos: heory, Methods and Applications Research Article JOURNAL OF Engineering

More information

Quadratic Extended Filtering in Nonlinear Systems with Uncertain Observations

Quadratic Extended Filtering in Nonlinear Systems with Uncertain Observations Applied Mathematical Sciences, Vol. 8, 2014, no. 4, 157-172 HIKARI Ltd, www.m-hiari.com http://dx.doi.org/10.12988/ams.2014.311636 Quadratic Extended Filtering in Nonlinear Systems with Uncertain Observations

More information

OPTIMAL ESTIMATION of DYNAMIC SYSTEMS

OPTIMAL ESTIMATION of DYNAMIC SYSTEMS CHAPMAN & HALL/CRC APPLIED MATHEMATICS -. AND NONLINEAR SCIENCE SERIES OPTIMAL ESTIMATION of DYNAMIC SYSTEMS John L Crassidis and John L. Junkins CHAPMAN & HALL/CRC A CRC Press Company Boca Raton London

More information

A KALMAN FILTERING TUTORIAL FOR UNDERGRADUATE STUDENTS

A KALMAN FILTERING TUTORIAL FOR UNDERGRADUATE STUDENTS A KALMAN FILTERING TUTORIAL FOR UNDERGRADUATE STUDENTS Matthew B. Rhudy 1, Roger A. Salguero 1 and Keaton Holappa 2 1 Division of Engineering, Pennsylvania State University, Reading, PA, 19610, USA 2 Bosch

More information

A Novel Gaussian Sum Filter Method for Accurate Solution to Nonlinear Filtering Problem

A Novel Gaussian Sum Filter Method for Accurate Solution to Nonlinear Filtering Problem A Novel Gaussian Sum Filter Method for Accurate Solution to Nonlinear Filtering Problem Gabriel Terejanu a Puneet Singla b Tarunraj Singh b Peter D. Scott a Graduate Student Assistant Professor Professor

More information

Performance Evaluation of Local State Estimation Methods in Bearings-only Tracking Problems

Performance Evaluation of Local State Estimation Methods in Bearings-only Tracking Problems 14th International Conference on Information Fusion Chicago, Illinois, USA, July -8, 211 Performance Evaluation of Local State Estimation ethods in Bearings-only Tracing Problems Ondřej Straa, Jindřich

More information

For final project discussion every afternoon Mark and I will be available

For final project discussion every afternoon Mark and I will be available Worshop report 1. Daniels report is on website 2. Don t expect to write it based on listening to one project (we had 6 only 2 was sufficient quality) 3. I suggest writing it on one presentation. 4. Include

More information

Lecture 4: Numerical Solution of SDEs, Itô Taylor Series, Gaussian Approximations

Lecture 4: Numerical Solution of SDEs, Itô Taylor Series, Gaussian Approximations Lecture 4: Numerical Solution of SDEs, Itô Taylor Series, Gaussian Approximations Simo Särkkä Aalto University, Finland November 18, 2014 Simo Särkkä (Aalto) Lecture 4: Numerical Solution of SDEs November

More information

State Estimation using Moving Horizon Estimation and Particle Filtering

State Estimation using Moving Horizon Estimation and Particle Filtering State Estimation using Moving Horizon Estimation and Particle Filtering James B. Rawlings Department of Chemical and Biological Engineering UW Math Probability Seminar Spring 2009 Rawlings MHE & PF 1 /

More information

MODELLING ANALYSIS & DESIGN OF DSP BASED NOVEL SPEED SENSORLESS VECTOR CONTROLLER FOR INDUCTION MOTOR DRIVE

MODELLING ANALYSIS & DESIGN OF DSP BASED NOVEL SPEED SENSORLESS VECTOR CONTROLLER FOR INDUCTION MOTOR DRIVE INTERNATIONAL JOURNAL OF ADVANCED RESEARCH IN ENGINEERING International Journal of Advanced Research in Engineering and Technology (IJARET), ISSN 0976 6480(Print), ISSN 0976 6499(Online), AND TECHNOLOGY

More information

STATISTICAL ORBIT DETERMINATION

STATISTICAL ORBIT DETERMINATION STATISTICAL ORBIT DETERMINATION Satellite Tracking Example of SNC and DMC ASEN 5070 LECTURE 6 4.08.011 1 We will develop a simple state noise compensation (SNC) algorithm. This algorithm adds process noise

More information

P3.11 A COMPARISON OF AN ENSEMBLE OF POSITIVE/NEGATIVE PAIRS AND A CENTERED SPHERICAL SIMPLEX ENSEMBLE

P3.11 A COMPARISON OF AN ENSEMBLE OF POSITIVE/NEGATIVE PAIRS AND A CENTERED SPHERICAL SIMPLEX ENSEMBLE P3.11 A COMPARISON OF AN ENSEMBLE OF POSITIVE/NEGATIVE PAIRS AND A CENTERED SPHERICAL SIMPLEX ENSEMBLE 1 INTRODUCTION Xuguang Wang* The Pennsylvania State University, University Park, PA Craig H. Bishop

More information

Hand Written Digit Recognition using Kalman Filter

Hand Written Digit Recognition using Kalman Filter International Journal of Electronics and Communication Engineering. ISSN 0974-2166 Volume 5, Number 4 (2012), pp. 425-434 International Research Publication House http://www.irphouse.com Hand Written Digit

More information

A Comparison of Nonlinear Kalman Filtering Applied to Feed forward Neural Networks as Learning Algorithms

A Comparison of Nonlinear Kalman Filtering Applied to Feed forward Neural Networks as Learning Algorithms A Comparison of Nonlinear Kalman Filtering Applied to Feed forward Neural Networs as Learning Algorithms Wieslaw Pietrusziewicz SDART Ltd One Central Par, Northampton Road Manchester M40 5WW, United Kindgom

More information

A NOVEL OPTIMAL PROBABILITY DENSITY FUNCTION TRACKING FILTER DESIGN 1

A NOVEL OPTIMAL PROBABILITY DENSITY FUNCTION TRACKING FILTER DESIGN 1 A NOVEL OPTIMAL PROBABILITY DENSITY FUNCTION TRACKING FILTER DESIGN 1 Jinglin Zhou Hong Wang, Donghua Zhou Department of Automation, Tsinghua University, Beijing 100084, P. R. China Control Systems Centre,

More information

ORBIT DETERMINATION AND DATA FUSION IN GEO

ORBIT DETERMINATION AND DATA FUSION IN GEO ORBIT DETERMINATION AND DATA FUSION IN GEO Joshua T. Horwood, Aubrey B. Poore Numerica Corporation, 4850 Hahns Pea Drive, Suite 200, Loveland CO, 80538 Kyle T. Alfriend Department of Aerospace Engineering,

More information

A student's t filter for heavy tailed process and measurement noise

A student's t filter for heavy tailed process and measurement noise A student's t filter for heavy tailed process and measurement noise Michael Roth, Emre Ozan and Fredri Gustafsson Linöping University Post Print N.B.: When citing this wor, cite the original article. Original

More information

Tracking of acoustic source in shallow ocean using field measurements

Tracking of acoustic source in shallow ocean using field measurements Indian Journal of Geo-Marine Sciences Vol. XX(X), XXX 215, pp. XXX-XXX Tracking of acoustic source in shallow ocean using field measurements K. G. Nagananda & G. V. Anand Department of Electronics and

More information

Velocity (Kalman Filter) Velocity (knots) Time (sec) Kalman Filter Accelerations 2.5. Acceleration (m/s2)

Velocity (Kalman Filter) Velocity (knots) Time (sec) Kalman Filter Accelerations 2.5. Acceleration (m/s2) KALMAN FILERING 1 50 Velocity (Kalman Filter) 45 40 35 Velocity (nots) 30 25 20 15 10 5 0 0 10 20 30 40 50 60 70 80 90 100 ime (sec) 3 Kalman Filter Accelerations 2.5 Acceleration (m/s2) 2 1.5 1 0.5 0

More information

Organization. I MCMC discussion. I project talks. I Lecture.

Organization. I MCMC discussion. I project talks. I Lecture. Organization I MCMC discussion I project talks. I Lecture. Content I Uncertainty Propagation Overview I Forward-Backward with an Ensemble I Model Reduction (Intro) Uncertainty Propagation in Causal Systems

More information

A Comparitive Study Of Kalman Filter, Extended Kalman Filter And Unscented Kalman Filter For Harmonic Analysis Of The Non-Stationary Signals

A Comparitive Study Of Kalman Filter, Extended Kalman Filter And Unscented Kalman Filter For Harmonic Analysis Of The Non-Stationary Signals International Journal of Scientific & Engineering Research, Volume 3, Issue 7, July-2012 1 A Comparitive Study Of Kalman Filter, Extended Kalman Filter And Unscented Kalman Filter For Harmonic Analysis

More information

THE well known Kalman filter [1], [2] is an optimal

THE well known Kalman filter [1], [2] is an optimal 1 Recursive Update Filtering for Nonlinear Estimation Renato Zanetti Abstract Nonlinear filters are often very computationally expensive and usually not suitable for real-time applications. Real-time navigation

More information

A comparison of estimation accuracy by the use of KF, EKF & UKF filters

A comparison of estimation accuracy by the use of KF, EKF & UKF filters Computational Methods and Eperimental Measurements XIII 779 A comparison of estimation accurac b the use of KF EKF & UKF filters S. Konatowski & A. T. Pieniężn Department of Electronics Militar Universit

More information

Automated Tuning of the Nonlinear Complementary Filter for an Attitude Heading Reference Observer

Automated Tuning of the Nonlinear Complementary Filter for an Attitude Heading Reference Observer Automated Tuning of the Nonlinear Complementary Filter for an Attitude Heading Reference Observer Oscar De Silva, George K.I. Mann and Raymond G. Gosine Faculty of Engineering and Applied Sciences, Memorial

More information

The Kalman Filter ImPr Talk

The Kalman Filter ImPr Talk The Kalman Filter ImPr Talk Ged Ridgway Centre for Medical Image Computing November, 2006 Outline What is the Kalman Filter? State Space Models Kalman Filter Overview Bayesian Updating of Estimates Kalman

More information

A low intricacy variable step-size partial update adaptive algorithm for Acoustic Echo Cancellation USNRao

A low intricacy variable step-size partial update adaptive algorithm for Acoustic Echo Cancellation USNRao ISSN: 77-3754 International Journal of Engineering and Innovative echnology (IJEI Volume 1, Issue, February 1 A low intricacy variable step-size partial update adaptive algorithm for Acoustic Echo Cancellation

More information

Certain Thoughts on Uncertainty Analysis for Dynamical Systems

Certain Thoughts on Uncertainty Analysis for Dynamical Systems Certain Thoughts on Uncertainty Analysis for Dynamical Systems!"#$$%&'(#)*+&!"#$%"&$%'()$%(*+&$,$-$+.(",/(0,&122341,&(5$#$67(8'.&1-.(!"#$%%&'()*+,-.+/01'&2+,304 5,#')67,-642849,:!'-(:'&4;4

More information

Introduction to Unscented Kalman Filter

Introduction to Unscented Kalman Filter Introduction to Unscented Kalman Filter 1 Introdution In many scientific fields, we use certain models to describe the dynamics of system, such as mobile robot, vision tracking and so on. The word dynamics

More information

Data assimilation in high dimensions

Data assimilation in high dimensions Data assimilation in high dimensions David Kelly Courant Institute New York University New York NY www.dtbkelly.com February 12, 2015 Graduate seminar, CIMS David Kelly (CIMS) Data assimilation February

More information

Kalman Filters with Uncompensated Biases

Kalman Filters with Uncompensated Biases Kalman Filters with Uncompensated Biases Renato Zanetti he Charles Stark Draper Laboratory, Houston, exas, 77058 Robert H. Bishop Marquette University, Milwaukee, WI 53201 I. INRODUCION An underlying assumption

More information

Data assimilation with and without a model

Data assimilation with and without a model Data assimilation with and without a model Tim Sauer George Mason University Parameter estimation and UQ U. Pittsburgh Mar. 5, 2017 Partially supported by NSF Most of this work is due to: Tyrus Berry,

More information

A new Hierarchical Bayes approach to ensemble-variational data assimilation

A new Hierarchical Bayes approach to ensemble-variational data assimilation A new Hierarchical Bayes approach to ensemble-variational data assimilation Michael Tsyrulnikov and Alexander Rakitko HydroMetCenter of Russia College Park, 20 Oct 2014 Michael Tsyrulnikov and Alexander

More information

On a Data Assimilation Method coupling Kalman Filtering, MCRE Concept and PGD Model Reduction for Real-Time Updating of Structural Mechanics Model

On a Data Assimilation Method coupling Kalman Filtering, MCRE Concept and PGD Model Reduction for Real-Time Updating of Structural Mechanics Model On a Data Assimilation Method coupling, MCRE Concept and PGD Model Reduction for Real-Time Updating of Structural Mechanics Model 2016 SIAM Conference on Uncertainty Quantification Basile Marchand 1, Ludovic

More information

A STUDY ON THE STATE ESTIMATION OF NONLINEAR ELECTRIC CIRCUITS BY UNSCENTED KALMAN FILTER

A STUDY ON THE STATE ESTIMATION OF NONLINEAR ELECTRIC CIRCUITS BY UNSCENTED KALMAN FILTER A STUDY ON THE STATE ESTIMATION OF NONLINEAR ELECTRIC CIRCUITS BY UNSCENTED KALMAN FILTER Esra SAATCI Aydın AKAN 2 e-mail: esra.saatci@iku.edu.tr e-mail: akan@istanbul.edu.tr Department of Electronic Eng.,

More information

Prediction-based adaptive control of a class of discrete-time nonlinear systems with nonlinear growth rate

Prediction-based adaptive control of a class of discrete-time nonlinear systems with nonlinear growth rate www.scichina.com info.scichina.com www.springerlin.com Prediction-based adaptive control of a class of discrete-time nonlinear systems with nonlinear growth rate WEI Chen & CHEN ZongJi School of Automation

More information

MATH 235: Inner Product Spaces, Assignment 7

MATH 235: Inner Product Spaces, Assignment 7 MATH 235: Inner Product Spaces, Assignment 7 Hand in questions 3,4,5,6,9, by 9:3 am on Wednesday March 26, 28. Contents Orthogonal Basis for Inner Product Space 2 2 Inner-Product Function Space 2 3 Weighted

More information

Cramér-Rao Bounds for Estimation of Linear System Noise Covariances

Cramér-Rao Bounds for Estimation of Linear System Noise Covariances Journal of Mechanical Engineering and Automation (): 6- DOI: 593/jjmea Cramér-Rao Bounds for Estimation of Linear System oise Covariances Peter Matiso * Vladimír Havlena Czech echnical University in Prague

More information

CERTAIN THOUGHTS ON UNCERTAINTY ANALYSIS FOR DYNAMICAL SYSTEMS

CERTAIN THOUGHTS ON UNCERTAINTY ANALYSIS FOR DYNAMICAL SYSTEMS CERTAIN THOUGHTS ON UNCERTAINTY ANALYSIS FOR DYNAMICAL SYSTEMS Puneet Singla Assistant Professor Department of Mechanical & Aerospace Engineering University at Buffalo, Buffalo, NY-1426 Probabilistic Analysis

More information

Parameterized Joint Densities with Gaussian Mixture Marginals and their Potential Use in Nonlinear Robust Estimation

Parameterized Joint Densities with Gaussian Mixture Marginals and their Potential Use in Nonlinear Robust Estimation Proceedings of the 2006 IEEE International Conference on Control Applications Munich, Germany, October 4-6, 2006 WeA0. Parameterized Joint Densities with Gaussian Mixture Marginals and their Potential

More information