Research Article Iterative and Algebraic Algorithms for the Computation of the Steady State Kalman Filter Gain

Similar documents
Research Article Global Systems for Mobile Position Tracking Using Kalman and Lainiotis Filters

PERIODIC KALMAN FILTER: STEADY STATE FROM THE BEGINNING

Recursive Solutions of the Matrix Equations X + A T X 1 A = Q and X A T X 1 A = Q

Research Article Weighted Measurement Fusion White Noise Deconvolution Filter with Correlated Noise for Multisensor Stochastic Systems

Optimal Distributed Lainiotis Filter

On the Hermitian solutions of the

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

Research Article Convex Polyhedron Method to Stability of Continuous Systems with Two Additive Time-Varying Delay Components

Research Article Almost Sure Central Limit Theorem of Sample Quantiles

Research Article The Laplace Likelihood Ratio Test for Heteroscedasticity

Research Article Partial Pole Placement in LMI Region

Research Article Attracting Periodic Cycles for an Optimal Fourth-Order Nonlinear Solver

Steady State Kalman Filter for Periodic Models: A New Approach. 1 Steady state Kalman filter for periodic models

Steady-state DKF. M. Sami Fadali Professor EE UNR

Research Article A Generalization of a Class of Matrices: Analytic Inverse and Determinant

RECURSIVE ESTIMATION AND KALMAN FILTERING

Research Article An Inverse Eigenvalue Problem for Jacobi Matrices

Research Article Some Generalizations and Modifications of Iterative Methods for Solving Large Sparse Symmetric Indefinite Linear Systems

Research Article Applying GG-Convex Function to Hermite-Hadamard Inequalities Involving Hadamard Fractional Integrals

Research Article Parametric Evaluations of the Rogers-Ramanujan Continued Fraction

Research Article A Note on the Solutions of the Van der Pol and Duffing Equations Using a Linearisation Method

Research Article Fast Constructions of Quantum Codes Based on Residues Pauli Block Matrices

Research Article He s Variational Iteration Method for Solving Fractional Riccati Differential Equation

Research Article The Adjacency Matrix of One Type of Directed Graph and the Jacobsthal Numbers and Their Determinantal Representation

PERTURBATION ANAYSIS FOR THE MATRIX EQUATION X = I A X 1 A + B X 1 B. Hosoo Lee

Research Article Remarks on Asymptotic Centers and Fixed Points

Research Article Asymptotic Behavior of the Solutions of System of Difference Equations of Exponential Form

Research Article An Iterative Algorithm for the Split Equality and Multiple-Sets Split Equality Problem

Optimal control and estimation

OPTIMAL CONTROL AND ESTIMATION

Research Article Mathematical Model and Cluster Synchronization for a Complex Dynamical Network with Two Types of Chaotic Oscillators

Riccati difference equations to non linear extended Kalman filter constraints

Research Article A Note on Kantorovich Inequality for Hermite Matrices

Research Article Multiple-Decision Procedures for Testing the Homogeneity of Mean for k Exponential Distributions

Research Article New Examples of Einstein Metrics in Dimension Four

Research Article The Dirichlet Problem on the Upper Half-Space

Research Article Translative Packing of Unit Squares into Squares

Research Article Finite Iterative Algorithm for Solving a Complex of Conjugate and Transpose Matrix Equation

Research Article Localization and Perturbations of Roots to Systems of Polynomial Equations

Min-Max Output Integral Sliding Mode Control for Multiplant Linear Uncertain Systems

Research Article Indefinite LQ Control for Discrete-Time Stochastic Systems via Semidefinite Programming

Research Article Stability Switches and Hopf Bifurcations in a Second-Order Complex Delay Equation

Simultaneous state and input estimation with partial information on the inputs

Here represents the impulse (or delta) function. is an diagonal matrix of intensities, and is an diagonal matrix of intensities.

ESTIMATOR STABILITY ANALYSIS IN SLAM. Teresa Vidal-Calleja, Juan Andrade-Cetto, Alberto Sanfeliu

Research Article A Nice Separation of Some Seiffert-Type Means by Power Means

Solving Separable Nonlinear Equations Using LU Factorization

Research Article Adaptive Control of Chaos in Chua s Circuit

The Kalman filter is arguably one of the most notable algorithms

Adaptive State Feedback Nash Strategies for Linear Quadratic Discrete-Time Games

Research Article Nonlinear Conjugate Gradient Methods with Wolfe Type Line Search

1 Kalman Filter Introduction

LQR, Kalman Filter, and LQG. Postgraduate Course, M.Sc. Electrical Engineering Department College of Engineering University of Salahaddin

Research Article Polynomial GCD Derived through Monic Polynomial Subtractions

4 Derivations of the Discrete-Time Kalman Filter

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

Research Article Diagonally Implicit Block Backward Differentiation Formulas for Solving Ordinary Differential Equations

Research Article On the Completely Positive and Positive Semidefinite-Preserving Cones Part III

Research Article Merrifield-Simmons Index in Random Phenylene Chains and Random Hexagon Chains

Research Article Approximation Algorithm for a System of Pantograph Equations

Research Article A Note about the General Meromorphic Solutions of the Fisher Equation

Research Article Normal and Osculating Planes of Δ-Regular Curves

Research Article New Partition Theoretic Interpretations of Rogers-Ramanujan Identities

Research Article Product of Extended Cesàro Operator and Composition Operator from Lipschitz Space to F p, q, s Space on the Unit Ball

State Estimation of Linear and Nonlinear Dynamic Systems

Research Article H Control Theory Using in the Air Pollution Control System

Research Article Another Proof of the Faithfulness of the Lawrence-Krammer Representation of the Braid Group B 3

Convergence of Square Root Ensemble Kalman Filters in the Large Ensemble Limit

KingSaudBinAbdulazizUniversityforHealthScience,Riyadh11481,SaudiArabia. Correspondence should be addressed to Raghib Abu-Saris;

Research Article On Factorizations of Upper Triangular Nonnegative Matrices of Order Three

Journal of Inequalities in Pure and Applied Mathematics

Research Article Powering Multiparameter Homotopy-Based Simulation with a Fast Path-Following Technique

Optimization-Based Control

Research Article On the Idempotent Solutions of a Kind of Operator Equations

Quadratic Extended Filtering in Nonlinear Systems with Uncertain Observations

Kalman Filter. Predict: Update: x k k 1 = F k x k 1 k 1 + B k u k P k k 1 = F k P k 1 k 1 F T k + Q

Stabilization with Disturbance Attenuation over a Gaussian Channel

Research Article Necklaces, Self-Reciprocal Polynomials, and q-cycles

Research Article The Solution Set Characterization and Error Bound for the Extended Mixed Linear Complementarity Problem

Research Article Solvability for a Coupled System of Fractional Integrodifferential Equations with m-point Boundary Conditions on the Half-Line

Research Article Mean Square Stability of Impulsive Stochastic Differential Systems

Research Article Global Attractivity of a Higher-Order Difference Equation

Research Article On a New Three-Step Class of Methods and Its Acceleration for Nonlinear Equations

Research Article The Numerical Solution of Problems in Calculus of Variation Using B-Spline Collocation Method

Parallel Properties of Poles of. Positive Functions and those of. Discrete Reactance Functions

The iterative methods for solving nonlinear matrix equation X + A X 1 A + B X 1 B = Q

Research Article P-Fuzzy Diffusion Equation Using Rules Base

Square-Root Algorithms of Recursive Least-Squares Wiener Estimators in Linear Discrete-Time Stochastic Systems

Research Article Representing Smoothed Spectrum Estimate with the Cauchy Integral

Research Article Bounds of Solutions of Integrodifferential Equations

Solving Homogeneous Systems with Sub-matrices

Research Article Design of PDC Controllers by Matrix Reversibility for Synchronization of Yin and Yang Chaotic Takagi-Sugeno Fuzzy Henon Maps

Research Article Minor Prime Factorization for n-d Polynomial Matrices over Arbitrary Coefficient Field

A NOVEL OPTIMAL PROBABILITY DENSITY FUNCTION TRACKING FILTER DESIGN 1

Conditions for successful data assimilation

Research Article Soliton Solutions for the Wick-Type Stochastic KP Equation

The Discrete Kalman Filtering of a Class of Dynamic Multiscale Systems

Research Article Completing a 2 2Block Matrix of Real Quaternions with a Partial Specified Inverse

HW2 - Due 01/30. Each answer must be mathematically justified. Don t forget your name.

Research Article A Note on the Central Limit Theorems for Dependent Random Variables

Transcription:

ISRN Applied Mathematics, Article ID 417623, 1 pages http://dx.doi.org/1.1155/214/417623 Research Article Iterative and Algebraic Algorithms for the Computation of the Steady State Kalman Filter Gain Nicholas Assimais 1,2 and Maria Adam 2 1 Department of Electronic Engineering, Technological Educational Institute of Central Greece, 3rdmOldNationalRoadLamia-Athens,351Lamia,Greece 2 Department of Computer Science and Biomedical Informatics, University of Thessaly, 2-4 Papasiopoulou Street, 351 Lamia, Greece Correspondence should be addressed to Maria Adam; madam@dib.uth.gr Received 24 February 214; Accepted 31 March 214; Published 4 May 214 Academic Editors: F. Ding, L. Guo, and H. C. So Copyright 214 N. Assimais and M. Adam. This is an open access article distributed under the Creative Commons Attribution License, which permits unrestricted use, distribution, and reproduction in any medium, provided the original wor is properly cited. The Kalman filter gain arises in linear estimation and is associated with linear systems. The gain is a matrix through which the estimation and the prediction of the state as well as the corresponding estimation and prediction error covariance matrices are computed. For time invariant and asymptotically stable systems, there exists a steady state value of the Kalman filter gain. The steady state Kalman filter gain is usually derived via the steady state prediction error covariance by first solving the corresponding Riccati equation. In this paper, we present iterative per-step and doubling algorithms as well as an algebraic algorithm for the steady state Kalman filter gain computation. These algorithms hold under conditions concerning the system parameters. The advantage of these algorithms is the autonomous computation of the steady state Kalman filter gain. 1. Introduction The Kalman filter gain arises in Kalman filter equations in linear estimation and is associated with linear systems. State space systems have been widely used in estimation theory to describe discrete time systems [1 5. It is nown [1 for time invariant systems that if the signal process model is asymptotically stable, then there exists a steady state value of the Kalman filter gain. Thus, the steady state gain is associated with time invariant systems described by the following state space equations: x +1 =Fx +w, (1) z =Hx + V, for,x is the n-dimensional state vector at time, z is the m-dimensional measurement vector at time, F is the n n system transition matrix, H is the m n output matrix, w is the plant noise at time, andv is the measurement noise at time. Also,{w } and {V } are Gaussian zero-mean white random processes with covariance matrices Q and R, respectively. The discrete time Kalman filter [1, 6 isthemostwellnown algorithm that solves the filtering problem. In fact, Kalman filter faces simultaneously two problems as follows. (i) Estimation:theaimistorecoverattime information about the state vector at time using measurements up till time. (ii) Prediction:theaimistoobtainattime information about the state vector at time +1using measurementsuptilltime; it is clear that prediction is related to the forecasting side of information processing. Kalman filter uses the measurements up till time in order to produce the (one step) prediction of the state vector and the corresponding prediction error covariance matrix P +1/, as well as producing the estimation of the state vector and the corresponding estimation error covariance matrix P /. The Kalman filter equations needed for the computation of

2 ISRN Applied Mathematics the prediction and estimation error covariance matrices are as follows: K =P / 1 H T [HP / 1 H T +R 1, (2) P / = (I K H) P / 1, (3) P +1/ =Q+FP / F T, (4) for, with initial condition P / 1 = P for the time instant,therearenomeasurementsgiven.notethat K is the Kalman filter gain. From (2)to(4), we are able to derive the Riccati equation, which is an iterative equation with respect to the prediction error covariance: P +1/ =Q+FP / 1 F T FP / 1 H T [HP / 1 H T +R 1 HP / 1 F T. In the general case, R and P are positive definite matrices, using in (5) the matrix inversion lemma: (5) [A+BCD 1 =A 1 A 1 B[C 1 +DA 1 B 1 DA 1, (6) the Riccati equation is formulated as P +1/ =Q+F[P 1 / 1 +HT R 1 H 1 F T. (7) The Riccati equation is a nonlinear iterative equation with respect to the prediction error covariance. For time invariant systems, it is well nown [1that if the signal process model is asymptotically stable, then there exists a steady state value P p of the prediction error covariance matrix. In fact, the prediction error covariance tends to the steady state prediction error covariance. The steady state prediction error covariance satisfies the steady state Riccati equation P p =Q+F[ P 1 p +HT R 1 H 1 F T. (8) Then, from (2), it is clear that there also exists a steady state value K of the Kalman filter gain [7. The steady state gaincanbecalculatedby K = P p H T [H P p H T +R 1. (9) Also, from (3), it is clear that there also exists a steady state value P e of the estimation error covariance matrix [7, which canbecalculatedby P e = P p P p H T [H P p H T +R 1 H P p =[ P 1 p +HT R 1 H 1. (1) It is obvious from (9) that the steady state Kalman filter gain can be derived via the steady state prediction error covariance. The covariance matrix in Kalman filter plays an important role in many applications [1, 4, 6, 8 1. The steady state prediction error covariance can be derived by solving the Riccati equation emanating from Kalman filter. The discrete time Riccati equation has attracted recent attention. In view of the importance of the Riccati equation, there exists considerable literature on its algebraic solutions; for example, in [1, 7, 11, 12, the authors have derived an eigenvector solution, while the author of [13 has included solving scalar polynomials. Other methods are based on the iterative solutions [1, 13 18 concerning per-step or doubling algorithms. The iterative algorithms that provide the steady state Kalman filter gain together with the prediction error covariance are the Chandrasehar algorithms [1, as well as the iterative algorithm that calculate the Kalman gain only once for a period of the stationary channel, as opposed to each data sample in the conventional filter [19. A geometric illustration of the Kalman filter gain is given in [2. In this paper, we present algorithms for the steady state Kalman filter gain autonomous computation. These algorithms hold under conditions concerning the system parameters. The paper is organized as follows: two new perstep iterative algorithms, a new doubling iterative algorithm, and an algebraic algorithm for the computation of the steady state Kalman filter gain are presented in Section 2. In Section 3, two examples verify the results. Finally, Section 4 summarizes the conclusions. 2. New Algorithms for the Steady State Kalman Filter Computation 2.1. Assumptions. We assume the general case, R and P are positive definite matrices. The Kalman filter gain K is a matrix of dimension n m. We define the matrix G =K H. (11) It is clear that G is a nonsymmetric matrix of dimension n n. It is also clear that there exists a steady state value Also, we define the matrix G = KH. (12) S=H T R 1 H. (13) Note that S is an n nsymmetric positive semidefinite matrix and S is a positive definite if ran(h) = n; thismeansthats is a nonsingular matrix in the case, ran(h) = n with m n, [21. 2.2. Indirect Steady State Kalman Filter Gain Computation. In this section, we present algorithms for G computation. Then, we show how to compute the steady state Kalman filter K through G = KH. 2.2.1. Iterative Algorithms for G Computation. In this section, we present two iterative per-step algorithms and an iterative doubling algorithm for G computation.

ISRN Applied Mathematics 3 Per-Step Iterative Algorithm 1. Using(2) and(11), it is derived that G =K H =P / 1 H T [HP / 1 H T +R 1 H =P / 1 H T [HP / 1 H T +R 1 RR 1 H =P / 1 H T ([HP / 1 H T +R 1 [HP / 1 H T +R HP / 1 H T ) R 1 H =P / 1 H T ([HP / 1 H T +R 1 [HP / 1 H T +R [HP / 1 H T +R 1 HP / 1 H T )R 1 H =P / 1 H T (I [HP / 1 H T +R 1 HP / 1 H T )R 1 H =P / 1 H T R 1 H P / 1 H T [HP / 1 H T +R 1 HP / 1 H T R 1 H = (P / 1 P / 1 H T [HP / 1 H T +R 1 HP / 1 ) H T R 1 H =[P 1 / 1 +HT R 1 H 1 H T R 1 H =[P 1 / 1 +S 1 S. Thus, arises (14) K H=[P 1 / 1 +S 1 S. (15) Using the Riccati equation (7), (15), the nonsingularity of S, and some algebra we have P +1/ =Q+F[P 1 / 1 +HT R 1 H 1 F T =Q+F[P 1 / 1 +S 1 F T =Q+FK HS 1 F T Also, from (2)and(13), we can write K (HP / 1 H T +R)=P / 1 H T K HP / 1 H T +K R=P / 1 H T K R=P / 1 H T K HP / 1 H T K R=(I K H) P / 1 H T K =(I K H) P / 1 H T R 1 K H=(I K H) P / 1 H T R 1 H K H=(I K H) P / 1 S. (17) Since the matrices P / 1,S are nonsingular, the last equation yields K HS 1 P 1 / 1 =I K H. (18) Substituting in (16)thematrixK +1 HS 1 P 1 +1/ by (18), it follows K +1 H(S 1 F T S) = K +1 HS 1 P 1 +1/ (QF T S+FK H) by it is implied that = (I K +1 H) (QF T S+FK H) =QF T S+FK H K +1 HQF T S K +1 HFK H, K +1 H(S 1 F T S) + K +1 HQF T S+K +1 HFK H =QF T S+FK H K +1 H(S 1 F T S+QF T S+FK H) =QF T S+FK H K +1 H=(QF T S+FK H) [S 1 F T S+QF T S+FK H 1. Thus, the above equation can be written as (19) (2) P +1/ S=QS+FK HS 1 F T S =QF T S[S 1 F T S 1 +FK H[S 1 F T S 1 P +1/ S(S 1 F T S) = QF T S+FK H (16) K +1 H=(QF T S+FK H) [S 1 F T S+QF T S+FK H 1. (21) Combining (21) with(11), the following nonlinear iterative equation with respect to G is derived: S 1 F T S=S 1 P 1 +1/ (QF T S+FK H) K +1 H(S 1 F T S) =K +1 HS 1 P 1 +1/ (QF T S+FK H). G +1 = ((QF T S) + (F) G ) [(S 1 F T S+QF T S) + (F) G 1 = (C+DG )[A+BG 1, (22)

4 ISRN Applied Mathematics A=(Q+S 1 )F T S, B=F, C=QF T S, (23) initial uncertainty, that is, independent of the value of the initial condition P.Thus,weareabletoassumezeroinitial condition P =. In this case, in order to avoid G 1,weareto use the initial condition G 1 =c. It is clear that G tends to a steady state value G and by (26) G satisfies D=F. G =c+a[ G 1 +b 1 d. (28) The algorithm uses the initial condition G = K H = P H T [HP H T +R 1 H.Itisnown[1 thattheprediction error covariance tends to the steady state prediction error covariance and that the convergence is independent of the initial uncertainty, that is, independent of the value of the initial condition P.Thus,weareabletoassumezeroinitial condition P =and so we are to use the initial condition G =. It is clear that G tends to a steady state value G and by (22) G satisfies G =(C+D G) [A + B G 1. (24) Per-Step Iterative Algorithm 2.Werewrite(22)as G +1 = (C+DG )[A+BG 1 = (CA 1 A+(D+CA 1 B CA 1 B) G )[A+BG 1 = (CA 1 (A + BG )+(D CA 1 B) G )[A+BG 1 =CA 1 +(D CA 1 B) G [A + BG 1 =CA 1 +(D CA 1 B) [AG 1 +B 1 =CA 1 +(D CA 1 B) [G 1 +A 1 B 1 A 1. (25) Thus, the following nonlinear iterative equation with respect to G is derived: G +1 =c+a[g 1 +b 1 d, (26) a=d CA 1 B=F Q[Q+S 1 1 F, b=a 1 B=S 1 F T [Q + S 1 1 F, c=ca 1 =Q[Q+S 1 1, d=a 1 =S 1 F T [Q + S 1 1. (27) The algorithm uses the initial condition G = K H = P H T [HP H T +R 1 H.Itisnown[1 thattheprediction error covariance tends to the steady state prediction error covariance and that the convergence is independent of the Doubling Iterative Algorithm. Ιn(22), setting we tae or G =K H=Y X 1, (29) Y +1 X 1 +1 =(C+DY X 1 )[A+BY X 1 1 =(CX +DY )[AX +BY 1 (3) [ X +1 Y +1 =Φ[ X Y, (31) C D =[(Q + S 1 )F T S F b QF T S F =[d 1 c c b+a (32) is a matrix of dimension 2n 2n and A, B, C, D as in (23). We are able to use zero initial condition P =,sog = K H=Y X 1 =;thatis, and hence We define with initial condition [ X =[ I, (33) Y [ X =Φ [ I. (34) Y Φ 2 = [ [ c b c b +a (35) Φ 2 = [ b = d 1 b [ c c b +a c c b+a. (36) Then, [ X(2 ) I Y(2 ) =Φ2 [, (37)

ISRN Applied Mathematics 5 and, using the doubling principle [1 Φ 2+1 =Φ 2 Φ 2,wehave +1 [ [ c +1 +1 = [ [ c +1 b +1 c +1 +1 b +1 +a +1 b c b +a [ [ c b c b +a. (38) Then we are able to derive, after some algebra, the following nonlinear iterative equations: a +1 =a (I c [I + b c 1 b )a, which is a matrix of dimension 2n 2n.Since det Φ= det (A) det (D CA 1 B) = det ((Q + S 1 )F T S) det (F QF T S[(Q + S 1 )F T S 1 F) = det (Q + S 1 ) det (F 1 ) det (S) det (F QF T SS 1 F T [Q + S 1 1 F) = det (S) det (F Q[Q + S 1 1 F) det (F 1 ) det (Q + S 1 ) (44) b +1 =b +d [I + b c 1 b a, c +1 =c +a c [I + b c 1 d, d +1 =d [I + b c 1 d, with initial conditions a 1 =D CA 1 B=F Q[Q+S 1 1 F, b 1 =A 1 B=S 1 F T [Q + S 1 1 F, c 1 =CA 1 =Q[Q+S 1 1, (39) (4) = det (S) det (I Q[Q+S 1 1 ) det (F) det (F 1 ) det (Q + S 1 ) = det (S) det ((Q + S 1 ) Q) = det (S) det (S 1 )=1, it is evident that Φ is a nonsingular matrix and its eigenvalues occur in reciprocal pairs. Thus, (43) canbewritten C D =[(Q + S 1 )F T S F QF T S F =WLW 1, (45) Then, since d 1 =A 1 =S 1 F T [Q + S 1 1. [ X(2 ) I Y(2 ) =Φ2 [ = [ [, (41) c it is clear that c =Y 2 X 1 2 =G 2 tends to a steady state value G. 2.2.2. Algebraic Algorithm for G Computation. In this section, we present an algebraic algorithm for G computation. As in (29), setting G =K H=Y X 1 (42) and using the parameters A, B, C, D by (23), we derive C D =[(Q + S 1 )F T S F, (43) QF T S F L=[ Λ Λ 1 (46) is a diagonal matrix containing the eigenvalues of Φ, withλ diagonal matrixwith all the eigenvalues of Φ lying outside the unit circle, and W=[ W 11 W 12 W 21 W 22 (47) is the matrix containing the corresponding eigenvectors of Φ, with V=W 1 =[ V 11 V 12 V 21 V 22. (48) We are able to use zero initial condition P =,sog = K H=Y X 1 =;thatis, and hence [ X =[ I, (49) Y [ X =Φ [ I. (5) Y

6 ISRN Applied Mathematics that is, Then, from (5) and(45) (48), we are able to write [ X Y =Φ [ I =[WLW 1 [ I =[ W 11 W 12 W 21 W 22 [ Λ Λ [ V 11 V 12 V 21 V 22 [ I ; (51) Per-Step Iterative Algorithm 1. Using(11), (22), and (13), we are able to derive the following nonlinear iterative equation with respect to the Kalman filter gain K : K +1 =G +1 H 1 = (QF T S+FG )[S 1 F T S+QF T S+FG 1 H 1 = (QF T H T R 1 H+FG ) [H 1 RH T F T H T R 1 H [ X Y =[ W 11Λ V 11 +W 12 Λ V 21 W 21 Λ V 11 +W 22 Λ V 21. (52) Substituting in (42)thematricesX, Y from (52), we have that +QF T H T R 1 H+FG 1 H 1 = (QF T H T R 1 H+FK H) [RH T F T H T R 1 H +HQF T H T R 1 H+HFK H 1 G =Y X 1 = (W 21 Λ V 11 +W 22 Λ V 21 ) [W 11 Λ V 11 +W 12 Λ V 21 1. (53) = (QF T H T R 1 +FK ) H [RH T F T H T R 1 H +HQF T H T R 1 H+HFK H 1 Furthermore, the diagonal matrix Λ 1 contains all the eigenvalues of Φ lying inside the unit circle, which follows that lim Λ =.Then,G tends to a steady state value G with G =lim G,andfrom(53)arises G =W 21 W 1 11. (54) 2.2.3. Steady State Kalman Filter Gain Computation. All algorithms presented in Sections 2.2.1 and 2.2.2 compute the steady state value G.Taingintoaccounttheassumptionsof Section 2.1, we are able to conclude that, under the condition ran(h) = n, the steady state gain is K = G[H T H 1 H T. (55) = (QF T H T R 1 +FK ) [RH T F T H T R 1 +HQF T H T R 1 +HFK 1 = (QF T H T R 1 +FK ) [HQF T H T R 1 +RH T F T H T R 1 +HFK 1. (56) The nonsingularity of S and (13) allowustowritethe equality in (56)as K +1 = (QF T H T R 1 +FK ) [HQF T H T R 1 +HS 1 F T H T R 1 +HFK 1 2.3. Direct Steady State Kalman Filter Gain Computation. In this section, we present algorithms for the direct computation of the steady state Kalman filter K.Theproposedalgorithms compute directly the steady state Kalman filter gain, that is, without using G = KH. All these algorithms hold under the assumption that n=m.notethat,sinceran(h) = n, H and S are nonsingular matrices. = (C+DK )[A+BK 1, A=HQF T H T R 1 +HS 1 F T H T R 1 =H(Q+S 1 )F T H T R 1, B=HF, (57) (58) 2.3.1. Iterative Algorithms for K Computation. In this section, we present two iterative per-step algorithms and an iterative doubling algorithm for K computation. C=QF T H T R 1, D=F.

ISRN Applied Mathematics 7 The initial condition is K = P H T [HP H T +R 1. It is nown [1 that the prediction error covariance tends to the steady state prediction error covariance and that the convergence is independent of the initial uncertainty, that is, independent of the value of the initial condition P.Thus,we are able to assume zero initial condition P =and so we are to use the initial condition K =. It is clear that K tends to a steady state value K satisfying K =(C+D K) [A + B K 1. (59) Per-Step Iterative Algorithm 2.Using(57),weareabletoderive the following nonlinear iterative equation with respect to the Kalman filter gain K : K +1 = (C+DK )[A+BK 1 = (CA 1 A+(D+CA 1 B CA 1 B) K )[A+BK 1 = (CA 1 (A + BK )+(D CA 1 B) K )[A+BK 1 we tae or Y +1 X 1 +1 =(C+DY X 1 )[A+BY X 1 1 =(CX +DY )[AX +BY 1 (64) [ X +1 Y +1 =Φ[ X Y, (65) b C D =[d 1 c c b+a (66) is a matrix of dimension 2n 2n and A, B, C, D as in (58). Woring as in the doubling iterative algorithm of Section 2.2.1 and using zero initial condition P =,so K =Y X 1 =;weareabletoderivethefollowingnonlinear iterative equations: a +1 =a (I c [I + b c 1 b )a, =CA 1 +(D CA 1 B) K [A + BK 1 =CA 1 +(D CA 1 B) [AK 1 =CA 1 +(D CA 1 B) [K 1 =c+a[k 1 +b 1 d, A, B, C, D are given by (58)and a=d CA 1 B, b=a 1 B, c=ca 1, +B 1 +A 1 B 1 A 1 (6) (61) with initial conditions b +1 =b +d [I + b c 1 b a, c +1 =c +a c [I+b c 1 d, d +1 =d [I+b c 1 d, a 1 =a, b 1 =b, c 1 =c, d 1 =d. (67) (68) It is clear that c =Y 2 X 1 2 =K 2 tends to a steady state value K. d=a 1. The algorithm uses the initial condition K = P H T [HP H T +R 1.Itisnown[1 thattheprediction error covariance tends to the steady state prediction error covariance and that the convergence is independent of the initial uncertainty, that is, independent of the value of the initial condition P.Thus,weareabletoassumezeroinitial condition P =. In this case, in order to avoid K 1,weare to use the initial condition K 1 =c. It is clear that K tends to a steady state value K satisfying K =c+a[ K 1 +b 1 d. (62) Doubling Iterative Algorithm. Ιn(57), setting K =Y X 1, (63) 2.3.2. Algebraic Algorithm for K Computation. In this section, we present an algebraic algorithm for K computation. Woring as in the algebraic algorithm of Section 2.2.2 and using the parameters A, B, C, D by (58), we derive C D =[W 11 W 12 [ Λ W 21 W 22 Λ 1 [ W 1 11 W 12, W 21 W 22 which is a matrix of dimension 2n 2n. Then, the steady state Kalman filter is (69) K =W 21 W 1 11. (7) 2.4. Advantages of the Proposed Algorithms. All algorithms forthecomputationofthesteadystatekalmanfiltergain K, presented in Section2, are summarized in Table 1.It is clearthatthedirectcomputationofthekalmanfiltergain

8 ISRN Applied Mathematics Computation of K through G = KH System parameters F, H, Q, R Restriction m n Table 1: Algorithms for the computation of the steady state Kalman filter gain K. Direct computation of K System parameters F, H, Q, R Restriction m=n Algorithms parameters Algorithms parameters A=(Q+(H T R 1 H) 1 )F T H T R 1 H A = H(Q+(H T R 1 H) 1 )F T H T R 1 B=F B=HF C=QF T H T R 1 H C = QF T H T R 1 D=F D=F a=d CA 1 B a = D CA 1 B b=a 1 B b = A 1 B c=ca 1 c=ca 1 d=a 1 d=a 1 Per-step iterative algorithm 1 Per-step iterative algorithm 1 G +1 = (C+DG )[A + BG 1 K +1 =(C+DK )[A + BK 1 G = K = G G K K K = G[H T H 1 H T Per-step iterative algorithm 2 Per-step iterative algorithm 2 G +1 =c+a[g 1 +b 1 d K +1 =c+a[k 1 +b 1 d G 1 =c K 1 =c G G K K K = G[H T H 1 H T Doubling iterative algorithm Doubling iterative algorithm a +1 =a (I c [I + b c 1 b )a b +1 =b +d [I + b c 1 b a c +1 =c +a c [I + b c 1 d a +1 =a (I c [I + b c 1 b )a b +1 =b +d [I + b c 1 b a c +1 =c +a c [I + b c 1 d d +1 =d [I + b c 1 d d +1 =d [I + b c 1 d a 1 =a,b 1 =b,c 1 =c,d 1 =d a 1 =a,b 1 =b,c 1 =c,d 1 =d c G c K K = G[H T H 1 H T Algebraic algorithm C D = [ W 11 W 12 [ Λ W 21 W 22 Λ 1[W 11 W 12 W 21 W 22 G =W 21 W 1 11 K = G[H T H 1 H T 1 Algebraic algorithm B Φ = [A C D = [ W 11 W 12 [ Λ W 21 W 22 Λ 1[W 11 W 12 W 21 W 22 K =W 21 W 1 11 1 is feasible only if the following restriction holds: n = m. The advantage of the presented algorithms is the autonomous computation of the steady state Kalman filter gain. Especially, the steady state Kalman filter gain is important, when we want to compute the parameters of the steady state Kalman filter x +1/+1 =(I KH) Fx / + Kz +1 =(I G) Fx / + Kz +1. (71) It is obvious from (71) that the parameters of the steady state Kalman filter are related to the steady state Kalman filter gain. In particular, the steady state prediction error covariance can be computed via the steady state gain and is given by P p = [I KH 1 KRH[H T H 1. (72) Indeed, from (2), arises K = P p H T [H P p H T +R 1,which leads to K(H P p H T +R)= P p H T KH P p H T + KR = P p H T P p H T KH P p H T = KR

ISRN Applied Mathematics 9 (I KH) P p H T = KR P p H T =[I KH 1 KR P p H T H=[I KH 1 KRH. (73) Since ran(h) = n,thematrixh T H is nonsingular [21; thus from the last equation arises immediately the formula of the steady state prediction error covariance in (72). Also, by (3), the steady state estimation error covariance can be computed via the steady state prediction error covariance P e =[I KH P p. (74) 3. Examples In this section, two examples verify the results of Section 2. Example 1. A model of dimensions n = 1 and m = 2 is assumed with parameters: F =.8, H=[ 1 2, Q=5, R=[.1.4. (75) Inthisexample,wehaveran(H) = n = 1 with m>n. Using all algorithms presented in Section 2.2, wecom- puted G =.992. (76) Then, using (55), we computedthesteady stategain K =[.198.3961. (77) Example 2. A model of dimensions m=n=2is assumed with parameters:.9.7 F=[.3.1, H=[ 1 3 2 2, Q=[ 1 3, (78) R=[.1.4. Inthisexample,wehaveran(H) = 2. Using all algorithms presented in Section 2.2, wecom- puted.8382.317 G =[. (79).647.9841 Then, using (55), we computedthesteady state gain.433.627 K =[. (8).4597.1975 We also computed the same steady state gain, using all algorithms presented in Section 2.3,since m=n=2. 4. Conclusions The Kalman filter gain arises in Kalman filter equations in linear estimation and is associated with linear systems. The gain is a matrix through which the estimation and the prediction of the state as well as the corresponding estimation and prediction error covariance matrices are computed. For time invariant and asymptotically stable systems, there exist steady state values of the estimation and prediction error covariance matrices. There exists also a steady state value of the Kalman filter gain. The steady state Kalman filter gain is usually derived via the steady state prediction error covariance by first solving the corresponding Riccati equation. In view of the importance of the Riccati equation, there exists considerable literature on its algebraic or iterative solutions, including the Chandrasehar algorithms, which are the only iterative algorithms that provide the steady state Kalman filter gain together with the prediction error covariance. Iterative per-step and doubling algorithms as well as an algebraic algorithm for the steady state Kalman filter computation were presented. These algorithms hold under conditions concerning the system parameters. The advantage of these algorithms is the autonomous computation of the steady state Kalman filter gain. This is important if we want to compute only the steady state Kalman filter gain or to compute the parameters of the steady state Kalman filter, whicharerelatedtothesteadystatekalmanfiltergain. Conflict of Interests The authors declare that there is no conflict of interests regarding the publication of this paper. References [1 B. D. O. Anderson and J. B. Moore, Optimal Filtering, Dover Publications, New Yor, NY, USA, 25. [2 N. Assimais and M. Adam, Global systems for mobile position tracing using Kalman and Lainiotis filters, The Scientific World Journal,vol.214,ArticleID13512,8pages,214. [3 F. Ding, Combined state and least squares parameter estimation algorithms for dynamic systems, Applied Mathematical Modelling,vol.38,no.1,pp.43 412,214. [4 F. Ding and T. Chen, Hierarchical identification of lifted statespace models for general dual-rate systems, IEEE Transactions on Circuits and Systems I: Regular Papers,vol.52,no.6,pp.1179 1187, 25. [5 B. Ristic, S. Arulampalam, and N. Gordon, Beyond the Kalman Filter,ArtechHouse,Boston,Mass,USA,24.

1 ISRN Applied Mathematics [6 M.S.GrewalandA.P.Andrews,Kalman Filtering: Theory and Practice Using MATLAB, John Wiley & Sons, Hoboen, NJ, USA, 3rd edition, 28. [7 N. Assimais and M. Adam, Kalman filter Riccati equation for the prediction, estimation and smoothing error covariance matrices, ISRN Computational Mathematics, vol. 213, Article ID 249594, 7 pages, 213. [8J.R.P.deCarvalho,E.D.Assad,andH.S.Pinto, Kalman filter and correction of the temperatures estimated by PRECIS model, Atmospheric Research, vol. 12, no. 1-2, pp. 218 226, 211. [9 R. Furrer and T. Bengtsson, Estimation of high-dimensional prior and posterior covariance matrices in Kalman filter variants, Multivariate Analysis,vol.98,no.2,pp.227 255, 27. [1 Y. Teruyama and T. Watanabe, Effectiveness of variable-gain Kalman filter based on angle error calculated from acceleration signals in lower limb angle measurement with inertial sensors, Computational and Mathematical Methods in Medicine, vol. 213,ArticleID39842,12pages,213. [11 S. Han, A closed-form solution to the discrete-time Kalman filter and its applications, Systems & Control Letters,vol.59,no. 12, pp. 799 85, 21. [12 D. R. Vaughan, A nonrecursive algebraic solution for the disczte Riccati equation, IEEE Transactions on Automatic Control, vol. 15, no. 5, pp. 597 599, 197. [13 R. Leland, An alternate calculation of the discrete-time Kalman filter gain and Riccati equation solution, Transactions on Automatic Control,vol.41,no.12,pp.1817 1819,1996. [14 N.Assimais, DiscretetimeRiccatiequationrecursivemultiple steps solutions, Contemporary Engineering Sciences, vol. 2, no.7,pp.333 354,29. [15 N. D. Assimais, D. G. Lainiotis, S. K. Katsias, and F. L. Sanida, A survey of recursive algorithms for the solution of the discrete time riccati equation, Nonlinear Analysis: Theory, Methods and Applications, vol. 3, no. 4, pp. 249 242, 1997. [16 N. Assimais, S. Roulis, and D. Lainiotis, Recursive solutions of the discrete time Riccati equation, Neural, Parallel and Scientific Computations,vol.11,no.3,pp.343 35,23. [17 D. G. Lainiotis, N. D. Assimais, and S. K. Katsias, A new computationally effective algorithm for solving the discrete Riccati equation, Mathematical Analysis and Applications, vol. 186, no. 3, pp. 868 895, 1994. [18 D. G. Lainiotis, N. D. Assimais, and S. K. Katsias, Fast and numerically robust recursive algorithms for solving the discrete time Riccati equation: the case of nonsingular plant noise covariance matrix, Neural, Parallel and Scientific Computations, vol. 3, no. 4, pp. 565 583, 1995. [19 M. Liyanage and I. Sasase, Steady-state Kalman filtering for channel estimation in OFDM systems utilizing SNR, in Proceedings of the IEEE International Conference on Communications (ICC 9), pp. 1 6, Dresden, Germany, June 29. [2 T. R. Kronhamn, Geometric illustration of the Kalman filter gain and covariance update algorithms, IEEE Control Systems Magazine,vol.5,no.2,pp.41 43,1985. [21 R. A. Horn and C. R. Johnson, Matrix Analysis, Cambridge University Press, Cambridge, UK, 25.

Advances in Operations Research Advances in Decision Sciences Applied Mathematics Algebra Probability and Statistics The Scientific World Journal International Differential Equations Submit your manuscripts at International Advances in Combinatorics Mathematical Physics Complex Analysis International Mathematics and Mathematical Sciences Mathematical Problems in Engineering Mathematics Discrete Mathematics Discrete Dynamics in Nature and Society Function Spaces Abstract and Applied Analysis International Stochastic Analysis Optimization