Linear Optimal Estimation Problems in Systems with Actuator Faults

Size: px
Start display at page:

Download "Linear Optimal Estimation Problems in Systems with Actuator Faults"

Transcription

1 14th International Conference on Information usion Chicago, Illinois, USA, July 5-8, 11 Optimal Estimation Problems in Systems with Actuator aults Daniel Sigalov echnion Israel Institute of echnology Program for Applied Mathematics Haifa 3, Israel Yaakov Oshman echnion Israel Institute of echnology Department of Aerospace Engineering Haifa 3, Israel Abstract We consider estimating the state of a dynamic system subject to actuator faults. he discretely-valued fault mechanism renders the system hybrid, and results in anomalous changes in the dynamics equation that may be interpreted as random accelerations. wo closely related problem formulations are considered. In the first formulation multiple models are used to describe the system s behavior: one model stands for the nominal, fault-free actuator condition, all other models correspond to various actuator fault conditions, and the system can freely assume any model at any time. In the second formulation the abnormal mode is described by a single dynamical model, and the system can switch between the nominal and anomalous conditions a bounded number of times, with the bound assumed known. In both formulations, the minimum mean squared error MMSE) optimal state estimator requires a polynomially growing number of primitive Kalman filters, and is, thus, computationally infeasible. We derive sequential, linear MMSE-optimal state estimation algorithms for both problem formulations. Depending only on the first two moments of the random quantities of the problem, linear optimal filters are robust with respect to the actual driving noise distributions, in the sense that they achieve the smallest worst-case estimation error of all other nonlinear) filters. Although derived assuming seemingly different problem formulations, both filters share essentially the same structure, thus exposing a certain duality between the underlying problems. he performance of both estimators is demonstrated in a simulation study, where they are compared to the interacting multiple model filter. Keywords: Multiple model estimation, target tracking, hybrid systems, fault detection and isolation. I. INRODUCION ault detection and isolation DI) is a task of prime importance in mission-critical systems, that are characterized by tough reliability requirements. Autonomous aerospace systems, e.g., missiles and unmanned airborne vehicles UAVs), are usually required to implement self-diagnostic tools that automatically detect faults, thus increasing efficiency and reducing risks. In addition, implementation of fault-tolerant systems is desired, such that the system s performance would not be severely affected by an undetected component fault. Avoiding explicit fault isolation and ensuing reconfiguration, fault-tolerant estimation and control schemes rely on assumed statistical models for the possible faults, and take them into account when estimating the overall system s state that may include the operational condition of the fault-prone components). his approach is taken in this paper, where we focus on fault-tolerant state estimation in the presence of random actuator faults. In compliance with [1 [3, we model actuator faults as additive terms in the state dynamics equation. However, instead of being unknown deterministic inputs, these are taken to be random) process noise terms with different statistical properties covariances) indicating anomalous actuator conditions. In addition, we allow the faults to explicitly alter the plant dynamics, such that, under a fault occurrence, the state transition matrix might change to one of its predefined non-nominal values. We consider two different problem formulations. In the first, we consider systems with intermittent faults modeled as an independent process. At any time an actuator may remain in its nominal, fault-free condition, or switch to one of possible faulty conditions. he second problem differs by the fault generation mechanism. Instead of allowing an arbitrary number of transitions between nominal and faulty actuator conditions, we assume that the number of such transitions is bounded by a known integer. As long as the number of transitions has not exceeded this bound, faults keep being generated in an independent manner, similarly to the first formulation. When the imal number of transitions has occurred, the system freezes in its current faulty or faultfree) mode. As will be discussed in the sequel, neither of these problem formulations may be represented as a special case of the other. Both problems considered here may be viewed as special cases of the hybrid system framework since the continuous uncertainty associated with the state variable is accompanied with the discrete one associated with the fault generation mechanism. It is well known [4 that under limited computational resources, the optimal state estimator in the minimum mean-squared error MMSE) sense does not exist for general hybrid systems. hus, when dealing with state estimation in hybrid systems, suboptimal approaches are usually considered. hese may be divided into two categories. he first category comprises efficient suboptimal estimators, with the nonlinear GPB [5 and [6 filters being the most popular and efficient ones. hese are designed to handle cases where the discrete uncertainty is governed by a Markov process, which may easily be adopted to our first problem formulation. or ISI 117

2 the case of a bounded number of mode transitions, such as the present paper s second problem formulation, an alternative to, recently proposed by the authors, may be utilized [7. Although, in practice, these filters demonstrate excellent performance in terms of the mean-squared error MSE) criterion, to the best of the authors knowledge, no theoretical performance guarantees are known to exist. Moreover, they explicitly assume that the system noises are Gaussian. he second category consists of estimators that are MMSEoptimal within the narrower subclass of linear filters. Among this class, Nahi [8 discussed the problem of independently evolving faults in the system sensors and derived a linear optimal estimator. His work was further generalized in [9 and [1 who derived linear filters for systems in which fault indicators in the measurement equation could be correlated. Costa [11 derived a linear optimal filter for general hybrid systems. However, for the case of actuator faults, the resulting filter requires state augmentation, increasing computational complexity and sacrificing the filter s desired sequential structure. Moreover, Costa s method does not apply for bounded cases, such as the second problem considered herein. Usually, linear filters do not outperform nonlinear, heuristic filters that belong to the first category. Nevertheless, their availability is important, because they possess a certain robustness property that is generally not shared by nonlinear filters. hus, linear estimators depend on the first two moments of the random quantities involved. Hence, as long as these moments are kept constant, these algorithms are indifferent to the specific noise distributions. Consequently, linear filters attain the smallest worst-case MSE, in comparison to any other nonlinear) filter. his makes their MSE a valuable bound when assessing the performance of other algorithms. In this paper we develop linear optimal estimators for the two problem formulations mentioned above. We show that in spite of the difference between the problems, both filters possess a similar structure, indicating conceptual similarities that are not obvious prior to the actual derivation. he remainder of this paper is organized as follows. In section II we formulate the problem at hand. he linear optimal estimators for both problem formulations are derived in Sections III and IV, respectively, and discussed in Section V. A simulation study, comparing both algorithms, is presented in section VI. Concluding remarks are made in section VII. II. PROBLEM ORMULAION Consider the following standard state-space representation of a stochastic dynamical system: x k+1 A k x k + w k 1) z k H k x k + v k. ) Here {w k } and {v k } are mutually independent, zero-mean white sequences with covariance matrices {Q k } and {R k }, respectively, independent of x, which is assumed to have zero mean and covariance P. he system 1) ) is specified by four matrix sequences {A k }, {H k }, {Q k }, and {R k }. At time k the set M k {A k, H k, Q k, R k } comprises the mode of the system. Different values of the mode correspond to, for example, different flight regimes of an aircraft, e.g., maneuvering/nonmaneuvering, or nominal/faulty conditions of an actuator. In this work we focus on modes that explicitly affect the dynamics equation 1). hus, the mode variable comprises the dynamics transition matrix A k and the covariance matrix of the process noise, Q k, namely, M k {A k, Q k }. We consider the case where, at time k, the mode M k may assume one of r possible values, m 1 through m r. We designate the mode m 1 as the nominal one corresponding to the fault-free actuator operation. he second set of modes, {m,...,m r }, represents various actuator fault conditions, that manifest themselves in sudden, unexpected accelerations. Even in the presence of faults, the state of the system x k may be estimated optimally in the mean-square sense using a standard Kalman filter, provided that the mode sequence evolves in time in a deterministic manner, namely, the exact value of M k is known for each k. he system mode M k is allowed to evolve according to some stochastic mechanism. wo such mechanisms are considered. In the first one, the value of the mode at time k, M k, is chosen according to some probability distribution defined over the set of r modes independently of the modes at other times. In the second mechanism, it is assumed that the total number of modes is r, and the total number of mode transitions is upper bounded by some known integer r 1. As long as the system has not performed r mode transitions, it alternates between the modes in an independent manner. Once r mode switches have been performed, the system remains in the most recent mode forever. here is a clear conceptual difference between the two transition laws considered herein. he conditional independence of the modes in the second formulation prevents the mode variables from being unconditionally independent. hus, it appears that solving the first problem does not provide a solution for the second one. he optimal MMSE estimate of the state x k based on the measurement sequence Z k {z,..., z k } is given by the conditional expectation E [x k Z k. he optimal filter for computing ˆx k E [x k Z k requires the use of primitive) Ks, in a number that grows exponentially in time, in the unbounded case i.e., when the number of mode transitions is unbounded) [4, and polynomially in time and exponentially in r, in the bounded case [1. hese observations call for a suboptimal solution approach. In both cases, our goal is to obtain linear optimal algorithms requiring moderate computational resources, that are capable of tracking the state x k using the measurements Z k {z 1,..., z k }. We thus set out to obtain the linear optimal estimator in the following sequential form: ˆx k+1 1 k)ˆx k + k)z k+1. 3) 1 Notice the difference between r and r. he same letter is used due to the similar role the quantities play in the derivations. 1173

3 Notice that, a-priori, it is not clear that the linear optimal estimators can be cast in the sought for sequential form 3). Our ensuing derivations show that, indeed, this can be done. Before proceeding with the actual derivations, we state the following well known theorem to justify the potential benefits in using linear optimal filters. heorem 1. Let P {p x, z)} be a family of probability distributions, all having the same first two moments. Let ˆx gz) be any estimator of x based on the observation z, and let ˆx L g L z) be the linear optimal estimator of x based on z. Denote by MSEg; p) the mean squared error of gz) corresponding to the distribution p, and let p arg MSEg; p) p P hen, MSEg; p ) MSEg L ; p ). Proof: By definition of p, MSEg; p ) MSEg; N). But, by linearity of the optimal filter in the Gaussian case, MSEg; N) MSEg L ; N). Recognizing that MSEg L ; p ) MSEg L ; N) then yields the result. heorem 1 tells us that the linear optimal estimator is also optimal in the mini sense [13, i.e., its worst-case MSE is not larger than that of any other estimator over the set of distributions having the same first two moments). In other words, for any nonlinear estimator, there exists a mismatching distribution of the process and measurement noises, for which it cannot outperform the linear optimal filter. III. UNBOUNDED NUMBER O MODE RANSIIONS Consider the following dynamical system x k+1 A k x k + w k 4) z k Hx k + v k, 5) where M k {A k, Q k } {m 1,..., m r } and r is a known integer. he mode transition dynamics is independent, such that, for i, j 1,...,r. P {M k+1 m i M k m j } P {M k+1 m i } p i, 6) where {p i } are known probabilities summing up to 1. With a slight abuse of notation, subscripts of A and Q will be used to denote different modes and not the time index, namely, m i {A i, Q i }. he first result of this paper is summarized in the following theorem. heorem. he linear optimal estimator has the sequential form 3) where 1 k) and k) are matrix coefficients that are given by: 1 k) I k)h) A i p i, 7) k) S k+1 [ H S k+1 A i p i V k A i p i V k ) A i p i H 1 A i p i )H + R, 8) where S k E [ x k x k and Vk E [ˆx kˆx k are given by S k+1 Ai S k A ) i + Q i pi, 9) V k+1 1 V k 1 + HS k+1 H + R) 1) ) + H A i p i V k V k A i p i )H. Proof: We prove the theorem constructively by showing that the expressions 7) and 8) for the coefficient matrices of the estimator 3) constitute sufficient conditions for the estimator s optimality in the linear MMSE LMMSE) sense. We do this by examining the following orthogonality conditions, that are known to be necessary and sufficient conditions for LMMSE optimality [14 E [ x k+1 ˆx k+1 )zj, j,...,k ) We proceed in three steps, omitting, for brevity, the explicit dependence of 1 and on k. Consider, first, the orthogonality conditions 11) for j,...,k. Substituting the estimator s equation 3) yields E [ x k+1 zj [ E 1ˆx k + z k+1 )zj E [ x k+1 zj [ E 1ˆx k + Hx k+1 + v k+1 ))zj E [ x k+1 zj 1 E [ˆx k zj HE [ x k+1 zj I H)E [ x k+1 zj 1 E [ˆx k zj, 1) where the third transition follows from the independence of v k+1 and z j for j < k + 1. Conditioning on the mode at time k, 1) becomes I H) E [ A i x k + w k )zj M k m i pi 1 E [ˆx k zj I H) A i E [ x k zj pi 1 E [ˆx k zj, 13) where we have utilized the facts that 1) the mode sequence is i.i.d. and, therefore, M k is independent of {x k, w k, z j }, and ) the sequences z j and w k are independent for j,...,k. Now, E [ x k zj E [ˆxk zj because of the optimality of ˆxk, rendering 7) a sufficient condition for LMMSE optimality. Consider, next, the last orthogonality condition in 11): E [ x k+1 ˆx k+1 ) z k+1. 14) Substituting 5) and 3) in 14), and utilizing the independence of v k+1 and x k+1, yields E [ x k+1 Hx k+1 + v k+1 ) E [ 1ˆx k + z k+1 )Hx k+1 + v k+1 ) E [ x k+1 x k+1 H 1 E [ˆx k x k+1 H E [ z k+1 x k+1 H E [ z k+1 vk+1 S k+1 H 1 E [ˆx k x k+1 H HS k+1 H R, 15) 1174

4 where we have defined S k E [ x k x k. Conditioning on Mk gives the expectation of the right hand side of 15) as E [ˆx k x k+1 E [ˆxk x r k A i p i E [ˆx kˆx r k A i p i, 16) where the last transition follows from orthogonality satisfied by ˆx k. Defining V k E [ˆx kˆx k and plugging into 15) yields the second relation between 1 and : I H)S k+1 H 1 V k A i p i R. 17) Substituting 7) in 17) and solving for yields 8). It remains to provide recursive schemes for the computation of the matrices S k and V k. We have S k+1 E [ x k+1 x k+1 M k m i pi [ Ai E x k + wk) i Ai x k + wk) i Mk i p i Ai S k A ) i + Q i pi. 18) V k+1 E [ 1ˆx k + z k+1 ) 1ˆx k + z k+1 ) 1 E [ˆx kˆx k 1 + E [ z k+1 z k+1 + E [ z k+1ˆx k E [ˆx k z k+1 1 V k 1 + HS k+1 H + R) + E [ z k+1ˆx k E [ˆx k z k+1. 19) It remains to compute E [ z k+1ˆx k E [ˆxk zk+1). o this end we condition once again on M k : E [ z k+1ˆx [ k HE xk+1ˆx k H E [ x k+1ˆx k M k m i pi H A i E [ x kˆx k pi H A i p i )V k, ) which completes the proof of the theorem. IV. BOUNDED NUMBER O MODE RANSIIONS or the second problem of this paper we next consider the case where the mode variable may assume one of two predefined values, namely, M k {A k, Q k } {m 1, m }. Under this formulation, one of the modes may stand for, e.g., a nominal, fault-free operation of the system, whereas the second mode describes a faulty, abnormal operation. he state space representation of the considered system is identical to the one used in the previous section. We assume that the total number of mode transitions from m 1 to m and vice versa) is bounded by a predefined known integer r. Mathematically, the mode transition law is described as follows. Let {N k } be a sequence of random variables assuming the values,...,r, such that N k l if l mode transitions have occurred by time k. hen, the mode at time k + 1 is chosen according to following stochastic rule { } P M k+1 m i Nk l, {M k } k k, {N k } k <k { p i, l < r, i {1, }, 1) δ i,r mod )+1, l r where {p i }, i {1, } are known probabilities and δ i,j is Kronecker s delta. hus, before r switches have occurred, the system switches independently between the two models. After r transitions, the most recent mode remains to be the system s active mode. or simplicity, and without loss of generality, we assume that the initial model is the nominal one, that is, P {M m 1 } 1. his assumption can be relaxed at the cost of a more cumbersome derivation. As before, we are looking for the linear optimal estimator of x k+1, given Z k {z 1,...,z k+1 }. he second result is summarized in the following theorem. heorem 3. or the second problem considered in this paper, the linear optimal estimator has the sequential form 3) with matrix coefficients 1 k) and k) given by: 1 k) I k)h) A l q l k), ) k) [ H S k+1 S k+1 A l q l V k A l q l V k A l q l )H 3) A l q l )H + R 1. Here A l A l mod )+1, and q l k) P {N k l}, that is computed, for 1 l k, as follows: and q l k) p l 1) mod ) q l 1 k 1) { p + l mod )+1 q l k 1), l < r q l k 1), l r, p 1 q k 1), l, k > q l k) 1, l k, l > k. he second-order moment matrix of x k, S k, satisfies S k+1 4) 5) Al S k A l + Q l ) ql k), 6) where Q l Q l mod )+1, and V k is the second-order moment matrix of ˆx k, that is computed via the recursive equation V k+1 1 V k 1 + HS k+1 H + R) 7) r ) r ) + H A l q l k) V k V k A l q l k) H. l1 l1 1175

5 Proof: Similarly to heorem, the constructive proof is based on enforcing the necessary and sufficient) orthogonality conditions on the recursive estimator 3). or notation simplicity we drop the explicit dependence of 1 and on k. Consider, first, the orthogonality conditions for j,..., k: E [ x k+1 ˆx k+1 )zj. 8) ollowing along the lines of the first step in the proof of heorem we obtain I H)E [ x k+1 zj 1 E [ˆx k zj. 9) Using the smoothing property of the conditional expectation on the first term on the RHS of 9) by conditioning on the number of mode transitions by time k, N k, yields I H) E [ x k+1 zj 1 E [ˆx k zj I H) E [ x k+1 zj N k l P {N k l} Nk l q l k) 1 E [ˆx k zj. 3) Now, under the event {N k l}, x k+1 is determined by the model l mod )+1 and, upon substituting the expression for ˆx k+1 from 3), 3) reads I H) E [ A l x k + wk)z l j Nk l q l 1 E [ˆx k zj I H) A l E [ x k zj ql 1 E [ˆx k zj, 31) where the conditioning on {N k i} has been omitted since, due to the conditional independence of the modes, N k is independent of x k, wk l, and z j. urther, note that wk l that should be interpreted as the process noise of the model corresponding to l mode transitions), and v k+1, are independent of z j. Using the orthogonality condition E [ˆx [ k zj E xk zj in 31) thus yields that ) is a sufficient condition for the fulfillment of the first k + 1 orthogonality conditions 8). Consider, next, the last orthogonality condition: E [ x k+1 ˆx k+1 )zk+1 E [ x k+1 zk+1 E [ˆxk+1 zk+1. 3) Substituting 1) and the conjectured form 3) into 3) yields E [ x k+1 Hx k+1 + v k+1 ) E [ 1ˆx k + z k+1 )Hx k+1 + v k+1 ) E [ x k+1 x k+1 H 1 E [ˆx k x k+1 H E [ z k+1 x k+1 H E [ z k+1 vk+1 S k+1 H 1 E [ˆx k x k+1 H HS k+1 H R I H)S k+1 H 1 E [ˆx k x k+1 H R, 33) where, as before, S k E [ x k x k. he remaining expectation on the RHS of 33) is computed by conditioning on N k E [ˆx r k x k+1 E [ˆx k x k+1 E [ˆx k x k Nk l q l E [ˆx k A l x k + w l k) Nk l q l r E [ˆx k x k A l ql A l q l E [ˆx kˆx k r A l q l, 34) where the last transition follows from the orthogonality obeyed by the linear optimal) estimate ˆx k. Substituting 34) and ) into 33) and solving for yields 3). inally, we derive the recursions for the second-order moment matrices. We have S k+1 r r E [ x k+1 x k+1 Nk l q l [ Al E x k + wk) l Al x k + wk) l Nk l q l Al S k A ) l + Q l ql. 35) V k+1 E [ 1ˆx k + z k+1 ) 1ˆx k + z k+1 ) 1 E [ˆx kˆx k 1 + E [ z k+1 z k+1 + E [ z k+1ˆx k E [ˆx k z k+1 1 V k 1 + HS k+1 H + R) + E [ z k+1ˆx k E [ˆx k z k+1. 36) o compute E [ z k+1ˆx k E [ˆxk zk+1) on the RHS of 36) we condition on N k : E [ z k+1ˆx [ k HE xk+1ˆx k H E [ x k+1ˆx k Nk l q l H l1 r H E [ A l x k + wk)ˆx l k ql l1 l1 thus completing the proof. A l E [ x kˆx k ql H V. DISCUSSION r l1 A l q l )V k 37) hough solving seemingly very different problems, it is readily seen that the linear optimal filters of Sections III and IV have strikingly similar structures. In fact, both estimators implement Kalman filter-like procedures, that use what can be called average transition matrices: r A ip i in the case 1176

6 of Section III, and r l1 A lq l in the case of Section IV. Moreover, the computational requirements of both filters are very similar, requiring the inversion of a matrix similar to the Kalman filter s innovation covariance matrix) that has the same dimensions in both cases. Indeed, this phenomenon exposes a fundamental duality between the two problems, that relates to the definition and role of the system modes in both cases. In the first case, there are r explicit dynamical modes, m 1,...,m r, each defined by a particular operational model the dynamic system follows in that mode. In the case with bounded number of transitions, there are just two such physical modes, but the duality exposed by the structural similarity of the linear optimal filters tells us that the system can be viewed as effectively having r temporal modes, each corresponding to a point in time when a physical transition has occurred before the imal number of transitions has been reached. In passing, we note that the notion of temporal multiple model is not new and was previously introduced in [15, where a nonlinear, heuristic filter was derived. We also note that the linear optimal filter of Section III could also be derived as a special case of the idea presented in [11. he present derivation, as opposed to the one in [11, does not require state augmentation, resulting in a more efficient algorithm. VI. NUMERICAL SUDY In this section we demonstrate the performance of the algorithms devised in Sections III and IV via a simple example, consisting of state estimation in a scalar stochastic dynamical system. he performance is compared to that of the stateof-the-art nonlinear algorithm [6 which, in the special case of independent mode dynamics, reduces to the GPB algorithm [16. We consider three numerical examples. In the first, we test a hybrid system driven by Gaussian noises, that alternates an unbounded number of times between nominal and faulty conditions. In the second, we change the distribution of the measurement noise from Gaussian to Laplacian, and demonstrate the robustness of the linear optimal filter and its advantage, in this regard, over the Gaussian distributionassuming. inally, we test the performance of the filter of Section IV in an example with a bounded number of mode transitions, and compare it to that of the unbounded filter and the nonlinear. he system considered is described by the state space model 1) and ), where x k is a one-dimensional state representing the target position at time k, initialized by x, P, and {w k } are i.i.d. zero mean Gaussian random variables with variances {q k }. he mode affects only the variance of the process noise, such that M k q k { σ1, σ}, where σ 1 represents the nominal variance, and σ represents the faulty case. he measurement noise sequence {v k } is zero mean with constant variance σv. In all examples in the sequel the following common parameters were used σ 1.1, σ, σ v 1. 38) A. Example 1: Unbounded number of faults, Gaussian case In this example the number of the faults is unbounded, and P { q k σ 1} 1 P { qk σ } p, 39) with p.95. he measurement noise is Gaussian. A single realization of the state sequence, accompanied by the measurements and estimates of the linear optimal and algorithms, as well as by the MMSE-optimal estimate of a genie-based filter, possessing perfect knowledge of the values of {q k }, is presented in ig. 1a). Squared position errors of the filters, averaged over 1, independent Monte Carlo runs, are presented in ig. 1b). he performance of the linear optimal algorithm is slightly inferior to that of the nonlinear. It is, however, much more efficient, since, as may be readily observed from the filter equations in Section III, its computational requirements are of a single K, as opposed to the that maintains two Ks in parallel and has an additional overhead due to the mixing stage. B. Example : Unbounded number of faults, Laplacian case he setting of this example is identical to that of Example 1, except that now the measurement noise has a Laplace distribution, retaining the same first and second-order moments as the Gaussian noise of Example 1. A sample realization of the state sequence, the measurements, and the corresponding estimated trajectories are presented in ig. a). Squared position errors of the filters, averaged over 1, independent Monte Carlo runs, are presented in ig. b). his example is a simple demonstration of the robustness of linear optimal filters, discussed in heorem 1. Since all second-order statistics are unaltered, the linear optimal filter generates essentially the same MSEs as in the Gaussian case of Example 1. he, on the other hand, is sensitive to the measurement noise distribution, and thus yields higher position errors. he somewhat inferior performance of the is best visualized via the sample run depicted in ig. a). As opposed to the Gaussian case, due to the heavy tails of the Laplace distribution, high-valued measurements are not as unlikely, as can be seen at, e.g., k 14, 61, 77. Operating under the Gaussian assumption, the filter interprets the correspondingly large innovations as originating from the faulty model, thus increasing the weight of the K corresponding to σ. his results in the strong spikes observable at the times of the seemingly abnormal measurements. Although the recovery from this mistaken interpretation of the measurements is rapid, the resulting overall MSE is increased. C. Example 3: Bounded Number of aults, Gaussian case In this example the number of transitions between the nominal and faulty modes is bounded by r 6. he measurement noise is Gaussian, and the conditional probabilities of the modes are P { q k σ1 N k < } 1 P { q k σ N k < } p, 4) 1177

7 6 4 arget Measurements ime a) Sample trajectory, measurements and estimates ime b) Average squared estimation error, Monte Carlo igure 1: Estimation performance, Example 1 Gaussian measurement noise) arget Measurements ime a) Sample trajectory, measurements and estimates Bounded ime b) Average squared estimation error, Monte Carlo igure : Estimation performance, Example Laplacian measurement noise). where, as before, p.95 and the rest of the parameters remain unchanged. In ig. 3 we compare the algorithm derived in Section IV to the linear optimal filter for the unbounded case and the algorithm, where the latter algorithms are implemented with the same mode probabilities as in the previous examples. In addition, we present, for reference, the squared errors of the MMSE-optimal genie-based K. All results are averaged over 1, independent Monte Carlo runs. ig. 3a) depicts the errors for the case when the filter for the bounded case assumes that the number of mode transitions is bounded by r 6. In other words, it operates under the nominal conditions it was designed for. he errors achieved by this filter coincide with those of the linear estimator for the unbounded case in the first third of the simulation interval. Both are slightly inferior to the nonlinear. In the second part of the interval, whereas the linear filter for the unbounded case remains inferior to the in compliance with the results of Example 1), the filter for the bounded case achieves significantly better errors, almost coinciding with the geniebased K. his is due to the fact that, after the imal number of transitions has been exhausted, a single K yields optimal results. In contradistinction, filters that do not take this into account, keep maintaining irrelevant Ks in the case of the ) or irrelevant terms in the filter gain in the case of the unbounded linear filter), thus increasing the MSE. In ig. 3b) we present an example demonstrating the 1178

8 .35.3 Bounded.35.3 Bounded ime ime a) Nominal r b) Underestimated r igure 3: Squared position estimation errors, Example 3 bounded number of transitions). robustness of the linear filter against imprecise knowledge of r. Whereas the true number of transition is 6, the filter uses as the bound on the number of transitions. Consequently, the errors generated at the beginning are higher than those of the nominal case, and are even worse than those of the linear filter for the unbounded case. However, the 6 transitions are eventually exhausted, and the filter s errors converge again to the optimal ones, resulting in a superior performance over the alternatives. It should be mentioned that, while being robust with respect to the exact value of r, the filter is not robust with respect to the parity of r. When such a mismatch occurs, the performance degrades severely. his is not very surprising, since, in the case of such a mismatch, the filter effectively operates, after the imal number of faults is exhausted, under an incorrect model. In contradistinction, the linear filter for the unbounded case and the utilize, to some extent, both dynamical models. VII. CONCLUDING REMARKS We have addressed the problem of state estimation in dynamical systems subject to random actuator faults. wo variants of the problem were considered, corresponding to cases with unbounded and deterministically bounded total number of mode transitions. Multiple number of modes are allowed in the first unbounded) case, whereas the bounded case permits just two system modes. or both problems we have derived sequential, linear optimal state estimation algorithms, that are known to be robust with respect to mismatch of the actual noise distributions to the assumed ones. hough originating from different problems, both filters share essentially the same structure, and may be viewed as dual to each other. he performance of both filters has been demonstrated through a numerical simulation study. REERENCES [1 R. V. Beard, ailure Accomodation in Systems hrough Self- Reorganization. PhD thesis, Dept. of Aeronautics and Astronautics, Massachusetts Inst. of echnology, eb [ W. Chung and J. Speyer, A Game heoretic ault Detection ilter, IEEE rans. on Automatic Control, vol. 43, no., pp , [3 R. Chen and J. Speyer, Sensor and Actuator ault Reconstruction, Journal of Guidance, Control, and Dynamics, vol. 7, no., pp , 4. [4 Y. Bar-Shalom, X. Li, and. Kirubarajan, Estimation with Applications to racking and Navigation. New York : Wiley, 1. [5 G. Ackerson and K. u, On state estimation in switching environments, IEEE rans. on Automatic Control, vol. 15, no. 1, pp. 1 17, 197. [6 H. Blom and Y. Bar-Shalom, he interacting multiple model algorithm for systems with Markovian switching coefficients, IEEE rans. on Automatic Control, vol. 33, no. 8, pp , [7 D. Sigalov and Y. Oshman, State estimation in hybrid systems with a bounded number of mode transitions, in Proc. usion 1, 13th International Conference on Information usion, 1. [8 N. Nahi, Optimal recursive estimation with uncertain observation, IEEE rans. on Information heory, vol. I-15, pp , July [9 Y. Sawaragi,. Katayama, and S. ujishige, Adaptive estimation for a linear system with interrupted observation, IEEE rans. on Automatic Control, vol. 18, no., pp , [1 M. Hadidi and S. Schwartz, recursive state estimators under uncertain observations, IEEE rans. on Automatic Control, vol. AC- 4, pp , December [11 O. Costa, minimum mean square error estimation for discretetime Markovian jump linear systems, IEEE rans. on Automatic Control, vol. 39, no. 8, pp , [1 D. Sigalov and Y. Oshman, Efficient tracking for hybrid systems with a bounded number of mode switches, Proc. 5th Israel Annual Conf. on Aerospace Sciences, ebruary 1. [13. Michaeli and Y. C. Eldar, Hidden relationships: Bayesian estimation with partial knowledge, IEEE ransactions on Signal Processing, 11. to appear. [14 A. Jazwinski, Stochastic Processes and iltering heory. Academic Press, 197. [15 G. Hexner, H. Weiss, and S. Dror, emporal Multiple Model Estimator for a Maneuvering arget, in Proc. of AIAA, GNC, 8. [16 B. D. Anderson and J. B. Moore, Optimal iltering. Prentice-Hall Information and System Sciences Series, Englewood Cliffs, New Jersey: Prentice-Hall,

Tracking Maneuvering Targets with a Soft Bound on the Number of Maneuvers

Tracking Maneuvering Targets with a Soft Bound on the Number of Maneuvers 4th International Conference on Information Fusion Chicago, Illinois, USA, July 5-8, 2 Tracking Maneuvering Targets with a Soft Bound on the Number of Maneuvers Daniel Sigalov Technion Israel Institute

More information

Linear Optimal State Estimation in Systems with Independent Mode Transitions

Linear Optimal State Estimation in Systems with Independent Mode Transitions Linear Optimal State Estimation in Systems with Independent Mode ransitions Daniel Sigalov, omer Michaeli and Yaakov Oshman echnion Israel Institute of echnology Abstract A generalized state space representation

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

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

9 Multi-Model State Estimation

9 Multi-Model State Estimation Technion Israel Institute of Technology, Department of Electrical Engineering Estimation and Identification in Dynamical Systems (048825) Lecture Notes, Fall 2009, Prof. N. Shimkin 9 Multi-Model State

More information

Design of Nearly Constant Velocity Track Filters for Brief Maneuvers

Design of Nearly Constant Velocity Track Filters for Brief Maneuvers 4th International Conference on Information Fusion Chicago, Illinois, USA, July 5-8, 20 Design of Nearly Constant Velocity rack Filters for Brief Maneuvers W. Dale Blair Georgia ech Research Institute

More information

Riccati difference equations to non linear extended Kalman filter constraints

Riccati difference equations to non linear extended Kalman filter constraints International Journal of Scientific & Engineering Research Volume 3, Issue 12, December-2012 1 Riccati difference equations to non linear extended Kalman filter constraints Abstract Elizabeth.S 1 & Jothilakshmi.R

More information

State estimation of linear dynamic system with unknown input and uncertain observation using dynamic programming

State estimation of linear dynamic system with unknown input and uncertain observation using dynamic programming Control and Cybernetics vol. 35 (2006) No. 4 State estimation of linear dynamic system with unknown input and uncertain observation using dynamic programming by Dariusz Janczak and Yuri Grishin Department

More information

Algorithm for Multiple Model Adaptive Control Based on Input-Output Plant Model

Algorithm for Multiple Model Adaptive Control Based on Input-Output Plant Model BULGARIAN ACADEMY OF SCIENCES CYBERNEICS AND INFORMAION ECHNOLOGIES Volume No Sofia Algorithm for Multiple Model Adaptive Control Based on Input-Output Plant Model sonyo Slavov Department of Automatics

More information

FUNDAMENTAL FILTERING LIMITATIONS IN LINEAR NON-GAUSSIAN SYSTEMS

FUNDAMENTAL FILTERING LIMITATIONS IN LINEAR NON-GAUSSIAN SYSTEMS FUNDAMENTAL FILTERING LIMITATIONS IN LINEAR NON-GAUSSIAN SYSTEMS Gustaf Hendeby Fredrik Gustafsson Division of Automatic Control Department of Electrical Engineering, Linköpings universitet, SE-58 83 Linköping,

More information

Lecture Outline. Target Tracking: Lecture 3 Maneuvering Target Tracking Issues. Maneuver Illustration. Maneuver Illustration. Maneuver Detection

Lecture Outline. Target Tracking: Lecture 3 Maneuvering Target Tracking Issues. Maneuver Illustration. Maneuver Illustration. Maneuver Detection REGLERTEKNIK Lecture Outline AUTOMATIC CONTROL Target Tracking: Lecture 3 Maneuvering Target Tracking Issues Maneuver Detection Emre Özkan emre@isy.liu.se Division of Automatic Control Department of Electrical

More information

PERIODIC KALMAN FILTER: STEADY STATE FROM THE BEGINNING

PERIODIC KALMAN FILTER: STEADY STATE FROM THE BEGINNING Journal of Mathematical Sciences: Advances and Applications Volume 1, Number 3, 2008, Pages 505-520 PERIODIC KALMAN FILER: SEADY SAE FROM HE BEGINNING MARIA ADAM 1 and NICHOLAS ASSIMAKIS 2 1 Department

More information

State Estimation by IMM Filter in the Presence of Structural Uncertainty 1

State Estimation by IMM Filter in the Presence of Structural Uncertainty 1 Recent Advances in Signal Processing and Communications Edited by Nios Mastorais World Scientific and Engineering Society (WSES) Press Greece 999 pp.8-88. State Estimation by IMM Filter in the Presence

More information

DESIGNING A KALMAN FILTER WHEN NO NOISE COVARIANCE INFORMATION IS AVAILABLE. Robert Bos,1 Xavier Bombois Paul M. J. Van den Hof

DESIGNING A KALMAN FILTER WHEN NO NOISE COVARIANCE INFORMATION IS AVAILABLE. Robert Bos,1 Xavier Bombois Paul M. J. Van den Hof DESIGNING A KALMAN FILTER WHEN NO NOISE COVARIANCE INFORMATION IS AVAILABLE Robert Bos,1 Xavier Bombois Paul M. J. Van den Hof Delft Center for Systems and Control, Delft University of Technology, Mekelweg

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

CS 532: 3D Computer Vision 6 th Set of Notes

CS 532: 3D Computer Vision 6 th Set of Notes 1 CS 532: 3D Computer Vision 6 th Set of Notes Instructor: Philippos Mordohai Webpage: www.cs.stevens.edu/~mordohai E-mail: Philippos.Mordohai@stevens.edu Office: Lieb 215 Lecture Outline Intro to Covariance

More information

Track-to-Track Fusion Architectures A Review

Track-to-Track Fusion Architectures A Review Itzhack Y. Bar-Itzhack Memorial Symposium on Estimation, Navigation, and Spacecraft Control, Haifa, Israel, October 14 17, 2012 Track-to-Track Architectures A Review Xin Tian and Yaakov Bar-Shalom This

More information

MMSE-Based Filtering for Linear and Nonlinear Systems in the Presence of Non-Gaussian System and Measurement Noise

MMSE-Based Filtering for Linear and Nonlinear Systems in the Presence of Non-Gaussian System and Measurement Noise MMSE-Based Filtering for Linear and Nonlinear Systems in the Presence of Non-Gaussian System and Measurement Noise I. Bilik 1 and J. Tabrikian 2 1 Dept. of Electrical and Computer Engineering, University

More information

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

ESTIMATOR STABILITY ANALYSIS IN SLAM. Teresa Vidal-Calleja, Juan Andrade-Cetto, Alberto Sanfeliu ESTIMATOR STABILITY ANALYSIS IN SLAM Teresa Vidal-Calleja, Juan Andrade-Cetto, Alberto Sanfeliu Institut de Robtica i Informtica Industrial, UPC-CSIC Llorens Artigas 4-6, Barcelona, 88 Spain {tvidal, cetto,

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

A PCR-BIMM filter For Maneuvering Target Tracking

A PCR-BIMM filter For Maneuvering Target Tracking A PCR-BIMM filter For Maneuvering Target Tracking Jean Dezert Benjamin Pannetier Originally published as Dezert J., Pannetier B., A PCR-BIMM filter for maneuvering target tracking, in Proc. of Fusion 21,

More information

4 Derivations of the Discrete-Time Kalman Filter

4 Derivations of the Discrete-Time Kalman Filter Technion Israel Institute of Technology, Department of Electrical Engineering Estimation and Identification in Dynamical Systems (048825) Lecture Notes, Fall 2009, Prof N Shimkin 4 Derivations of the Discrete-Time

More information

Networked Sensing, Estimation and Control Systems

Networked Sensing, Estimation and Control Systems Networked Sensing, Estimation and Control Systems Vijay Gupta University of Notre Dame Richard M. Murray California Institute of echnology Ling Shi Hong Kong University of Science and echnology Bruno Sinopoli

More information

Background on Coherent Systems

Background on Coherent Systems 2 Background on Coherent Systems 2.1 Basic Ideas We will use the term system quite freely and regularly, even though it will remain an undefined term throughout this monograph. As we all have some experience

More information

LINEAR MMSE ESTIMATION

LINEAR MMSE ESTIMATION LINEAR MMSE ESTIMATION TERM PAPER FOR EE 602 STATISTICAL SIGNAL PROCESSING By, DHEERAJ KUMAR VARUN KHAITAN 1 Introduction Linear MMSE estimators are chosen in practice because they are simpler than the

More information

Stochastic Realization of Binary Exchangeable Processes

Stochastic Realization of Binary Exchangeable Processes Stochastic Realization of Binary Exchangeable Processes Lorenzo Finesso and Cecilia Prosdocimi Abstract A discrete time stochastic process is called exchangeable if its n-dimensional distributions are,

More information

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

Square-Root Algorithms of Recursive Least-Squares Wiener Estimators in Linear Discrete-Time Stochastic Systems Proceedings of the 17th World Congress The International Federation of Automatic Control Square-Root Algorithms of Recursive Least-Squares Wiener Estimators in Linear Discrete-Time Stochastic Systems Seiichi

More information

NONUNIFORM SAMPLING FOR DETECTION OF ABRUPT CHANGES*

NONUNIFORM SAMPLING FOR DETECTION OF ABRUPT CHANGES* CIRCUITS SYSTEMS SIGNAL PROCESSING c Birkhäuser Boston (2003) VOL. 22, NO. 4,2003, PP. 395 404 NONUNIFORM SAMPLING FOR DETECTION OF ABRUPT CHANGES* Feza Kerestecioğlu 1,2 and Sezai Tokat 1,3 Abstract.

More information

State Estimation for Nonlinear Systems using Restricted Genetic Optimization

State Estimation for Nonlinear Systems using Restricted Genetic Optimization State Estimation for Nonlinear Systems using Restricted Genetic Optimization Santiago Garrido, Luis Moreno, and Carlos Balaguer Universidad Carlos III de Madrid, Leganés 28911, Madrid (Spain) Abstract.

More information

Tracking and Identification of Multiple targets

Tracking and Identification of Multiple targets Tracking and Identification of Multiple targets Samir Hachour, François Delmotte, Eric Lefèvre, David Mercier Laboratoire de Génie Informatique et d'automatique de l'artois, EA 3926 LGI2A first name.last

More information

Robotics 2 Target Tracking. Kai Arras, Cyrill Stachniss, Maren Bennewitz, Wolfram Burgard

Robotics 2 Target Tracking. Kai Arras, Cyrill Stachniss, Maren Bennewitz, Wolfram Burgard Robotics 2 Target Tracking Kai Arras, Cyrill Stachniss, Maren Bennewitz, Wolfram Burgard Slides by Kai Arras, Gian Diego Tipaldi, v.1.1, Jan 2012 Chapter Contents Target Tracking Overview Applications

More information

Time Series Prediction by Kalman Smoother with Cross-Validated Noise Density

Time Series Prediction by Kalman Smoother with Cross-Validated Noise Density Time Series Prediction by Kalman Smoother with Cross-Validated Noise Density Simo Särkkä E-mail: simo.sarkka@hut.fi Aki Vehtari E-mail: aki.vehtari@hut.fi Jouko Lampinen E-mail: jouko.lampinen@hut.fi Abstract

More information

Optimal State Estimators for Linear Systems with Unknown Inputs

Optimal State Estimators for Linear Systems with Unknown Inputs Optimal tate Estimators for Linear ystems with Unknown Inputs hreyas undaram and Christoforos N Hadjicostis Abstract We present a method for constructing linear minimum-variance unbiased state estimators

More information

Auxiliary signal design for failure detection in uncertain systems

Auxiliary signal design for failure detection in uncertain systems Auxiliary signal design for failure detection in uncertain systems R. Nikoukhah, S. L. Campbell and F. Delebecque Abstract An auxiliary signal is an input signal that enhances the identifiability of a

More information

Sequential Monte Carlo methods for filtering of unobservable components of multidimensional diffusion Markov processes

Sequential Monte Carlo methods for filtering of unobservable components of multidimensional diffusion Markov processes Sequential Monte Carlo methods for filtering of unobservable components of multidimensional diffusion Markov processes Ellida M. Khazen * 13395 Coppermine Rd. Apartment 410 Herndon VA 20171 USA Abstract

More information

The optimal filtering of a class of dynamic multiscale systems

The optimal filtering of a class of dynamic multiscale systems Science in China Ser. F Information Sciences 2004 Vol.47 No.4 50 57 50 he optimal filtering of a class of dynamic multiscale systems PAN Quan, ZHANG Lei, CUI Peiling & ZHANG Hongcai Department of Automatic

More information

ENGR352 Problem Set 02

ENGR352 Problem Set 02 engr352/engr352p02 September 13, 2018) ENGR352 Problem Set 02 Transfer function of an estimator 1. Using Eq. (1.1.4-27) from the text, find the correct value of r ss (the result given in the text is incorrect).

More information

The Kalman Filter. Data Assimilation & Inverse Problems from Weather Forecasting to Neuroscience. Sarah Dance

The Kalman Filter. Data Assimilation & Inverse Problems from Weather Forecasting to Neuroscience. Sarah Dance The Kalman Filter Data Assimilation & Inverse Problems from Weather Forecasting to Neuroscience Sarah Dance School of Mathematical and Physical Sciences, University of Reading s.l.dance@reading.ac.uk July

More information

Conditions for Suboptimal Filter Stability in SLAM

Conditions for Suboptimal Filter Stability in SLAM Conditions for Suboptimal Filter Stability in SLAM Teresa Vidal-Calleja, Juan Andrade-Cetto and Alberto Sanfeliu Institut de Robòtica i Informàtica Industrial, UPC-CSIC Llorens Artigas -, Barcelona, Spain

More information

Simultaneous Localization and Mapping (SLAM) Corso di Robotica Prof. Davide Brugali Università degli Studi di Bergamo

Simultaneous Localization and Mapping (SLAM) Corso di Robotica Prof. Davide Brugali Università degli Studi di Bergamo Simultaneous Localization and Mapping (SLAM) Corso di Robotica Prof. Davide Brugali Università degli Studi di Bergamo Introduction SLAM asks the following question: Is it possible for an autonomous vehicle

More information

A COMPARISON OF TWO METHODS FOR STOCHASTIC FAULT DETECTION: THE PARITY SPACE APPROACH AND PRINCIPAL COMPONENTS ANALYSIS

A COMPARISON OF TWO METHODS FOR STOCHASTIC FAULT DETECTION: THE PARITY SPACE APPROACH AND PRINCIPAL COMPONENTS ANALYSIS A COMPARISON OF TWO METHODS FOR STOCHASTIC FAULT DETECTION: THE PARITY SPACE APPROACH AND PRINCIPAL COMPONENTS ANALYSIS Anna Hagenblad, Fredrik Gustafsson, Inger Klein Department of Electrical Engineering,

More information

Online tests of Kalman filter consistency

Online tests of Kalman filter consistency Tampere University of Technology Online tests of Kalman filter consistency Citation Piché, R. (216). Online tests of Kalman filter consistency. International Journal of Adaptive Control and Signal Processing,

More information

Variable Learning Rate LMS Based Linear Adaptive Inverse Control *

Variable Learning Rate LMS Based Linear Adaptive Inverse Control * ISSN 746-7659, England, UK Journal of Information and Computing Science Vol., No. 3, 6, pp. 39-48 Variable Learning Rate LMS Based Linear Adaptive Inverse Control * Shuying ie, Chengjin Zhang School of

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

SOLVING POWER AND OPTIMAL POWER FLOW PROBLEMS IN THE PRESENCE OF UNCERTAINTY BY AFFINE ARITHMETIC

SOLVING POWER AND OPTIMAL POWER FLOW PROBLEMS IN THE PRESENCE OF UNCERTAINTY BY AFFINE ARITHMETIC SOLVING POWER AND OPTIMAL POWER FLOW PROBLEMS IN THE PRESENCE OF UNCERTAINTY BY AFFINE ARITHMETIC Alfredo Vaccaro RTSI 2015 - September 16-18, 2015, Torino, Italy RESEARCH MOTIVATIONS Power Flow (PF) and

More information

New Fast Kalman filter method

New Fast Kalman filter method New Fast Kalman filter method Hojat Ghorbanidehno, Hee Sun Lee 1. Introduction Data assimilation methods combine dynamical models of a system with typically noisy observations to obtain estimates of the

More information

RAO-BLACKWELLISED PARTICLE FILTERS: EXAMPLES OF APPLICATIONS

RAO-BLACKWELLISED PARTICLE FILTERS: EXAMPLES OF APPLICATIONS RAO-BLACKWELLISED PARTICLE FILTERS: EXAMPLES OF APPLICATIONS Frédéric Mustière e-mail: mustiere@site.uottawa.ca Miodrag Bolić e-mail: mbolic@site.uottawa.ca Martin Bouchard e-mail: bouchard@site.uottawa.ca

More information

Expressions for the covariance matrix of covariance data

Expressions for the covariance matrix of covariance data Expressions for the covariance matrix of covariance data Torsten Söderström Division of Systems and Control, Department of Information Technology, Uppsala University, P O Box 337, SE-7505 Uppsala, Sweden

More information

RECURSIVE ESTIMATION AND KALMAN FILTERING

RECURSIVE ESTIMATION AND KALMAN FILTERING Chapter 3 RECURSIVE ESTIMATION AND KALMAN FILTERING 3. The Discrete Time Kalman Filter Consider the following estimation problem. Given the stochastic system with x k+ = Ax k + Gw k (3.) y k = Cx k + Hv

More information

Prediction, filtering and smoothing using LSCR: State estimation algorithms with guaranteed confidence sets

Prediction, filtering and smoothing using LSCR: State estimation algorithms with guaranteed confidence sets 2 5th IEEE Conference on Decision and Control and European Control Conference (CDC-ECC) Orlando, FL, USA, December 2-5, 2 Prediction, filtering and smoothing using LSCR: State estimation algorithms with

More information

Optimal Polynomial Control for Discrete-Time Systems

Optimal Polynomial Control for Discrete-Time Systems 1 Optimal Polynomial Control for Discrete-Time Systems Prof Guy Beale Electrical and Computer Engineering Department George Mason University Fairfax, Virginia Correspondence concerning this paper should

More information

Simulation-based Optimal Design of α-β-γ-δ Filter

Simulation-based Optimal Design of α-β-γ-δ Filter International Journal of Automation and Computing 7(2), May 2010, 247-253 DOI: 10.1007/s11633-010-0247-8 Simulation-based Optimal Design of α-β-γ-δ Filter Chun-Mu Wu 1 Paul P. Lin 2 Zhen-Yu Han 3 Shu-Rong

More information

RESEARCH ARTICLE. Online quantization in nonlinear filtering

RESEARCH ARTICLE. Online quantization in nonlinear filtering Journal of Statistical Computation & Simulation Vol. 00, No. 00, Month 200x, 3 RESEARCH ARTICLE Online quantization in nonlinear filtering A. Feuer and G. C. Goodwin Received 00 Month 200x; in final form

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

Generalized Framework of OKID for Linear State-Space Model Identification

Generalized Framework of OKID for Linear State-Space Model Identification Generalized Framework of OKID for Linear State-Space Model Identification Francesco Vicario, Minh Q. Phan, Richard W. Longman, and Raimondo Betti Abstract This paper presents a generalization of observer/kalman

More information

5682 IEEE TRANSACTIONS ON INFORMATION THEORY, VOL. 55, NO. 12, DECEMBER /$ IEEE

5682 IEEE TRANSACTIONS ON INFORMATION THEORY, VOL. 55, NO. 12, DECEMBER /$ IEEE 5682 IEEE TRANSACTIONS ON INFORMATION THEORY, VOL. 55, NO. 12, DECEMBER 2009 Hyperplane-Based Vector Quantization for Distributed Estimation in Wireless Sensor Networks Jun Fang, Member, IEEE, and Hongbin

More information

Development of Stochastic Artificial Neural Networks for Hydrological Prediction

Development of Stochastic Artificial Neural Networks for Hydrological Prediction Development of Stochastic Artificial Neural Networks for Hydrological Prediction G. B. Kingston, M. F. Lambert and H. R. Maier Centre for Applied Modelling in Water Engineering, School of Civil and Environmental

More information

Inference Methods for Autonomous Stochastic Linear Hybrid Systems

Inference Methods for Autonomous Stochastic Linear Hybrid Systems Inference Methods for Autonomous Stochastic Linear Hybrid Systems Hamsa Balakrishnan, Inseok Hwang, Jung Soon Jang, and Claire J. Tomlin Hybrid Systems Laboratory Department of Aeronautics and Astronautics

More information

Towards inference for skewed alpha stable Levy processes

Towards inference for skewed alpha stable Levy processes Towards inference for skewed alpha stable Levy processes Simon Godsill and Tatjana Lemke Signal Processing and Communications Lab. University of Cambridge www-sigproc.eng.cam.ac.uk/~sjg Overview Motivation

More information

CONTROL SYSTEMS, ROBOTICS AND AUTOMATION Vol. VIII Kalman Filters - Mohinder Singh Grewal

CONTROL SYSTEMS, ROBOTICS AND AUTOMATION Vol. VIII Kalman Filters - Mohinder Singh Grewal KALMAN FILERS Mohinder Singh Grewal California State University, Fullerton, USA Keywords: Bierman, hornton, Cholesky decomposition, continuous time optimal estimator, covariance, estimators, filters, GPS,

More information

L06. LINEAR KALMAN FILTERS. NA568 Mobile Robotics: Methods & Algorithms

L06. LINEAR KALMAN FILTERS. NA568 Mobile Robotics: Methods & Algorithms L06. LINEAR KALMAN FILTERS NA568 Mobile Robotics: Methods & Algorithms 2 PS2 is out! Landmark-based Localization: EKF, UKF, PF Today s Lecture Minimum Mean Square Error (MMSE) Linear Kalman Filter Gaussian

More information

A Study of Covariances within Basic and Extended Kalman Filters

A Study of Covariances within Basic and Extended Kalman Filters A Study of Covariances within Basic and Extended Kalman Filters David Wheeler Kyle Ingersoll December 2, 2013 Abstract This paper explores the role of covariance in the context of Kalman filters. The underlying

More information

Estimation for Nonlinear Dynamical Systems over Packet-Dropping Networks

Estimation for Nonlinear Dynamical Systems over Packet-Dropping Networks Estimation for Nonlinear Dynamical Systems over Packet-Dropping Networks Zhipu Jin Chih-Kai Ko and Richard M Murray Abstract Two approaches, the extended Kalman filter (EKF) and moving horizon estimation

More information

Finite-Horizon Optimal State-Feedback Control of Nonlinear Stochastic Systems Based on a Minimum Principle

Finite-Horizon Optimal State-Feedback Control of Nonlinear Stochastic Systems Based on a Minimum Principle Finite-Horizon Optimal State-Feedbac Control of Nonlinear Stochastic Systems Based on a Minimum Principle Marc P Deisenroth, Toshiyui Ohtsua, Florian Weissel, Dietrich Brunn, and Uwe D Hanebec Abstract

More information

Kalman Filter. Man-Wai MAK

Kalman Filter. Man-Wai MAK Kalman Filter Man-Wai MAK Dept. of Electronic and Information Engineering, The Hong Kong Polytechnic University enmwmak@polyu.edu.hk http://www.eie.polyu.edu.hk/ mwmak References: S. Gannot and A. Yeredor,

More information

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

Here represents the impulse (or delta) function. is an diagonal matrix of intensities, and is an diagonal matrix of intensities. 19 KALMAN FILTER 19.1 Introduction In the previous section, we derived the linear quadratic regulator as an optimal solution for the fullstate feedback control problem. The inherent assumption was that

More information

Target tracking and classification for missile using interacting multiple model (IMM)

Target tracking and classification for missile using interacting multiple model (IMM) Target tracking and classification for missile using interacting multiple model (IMM Kyungwoo Yoo and Joohwan Chun KAIST School of Electrical Engineering Yuseong-gu, Daejeon, Republic of Korea Email: babooovv@kaist.ac.kr

More information

Fisher Information Matrix-based Nonlinear System Conversion for State Estimation

Fisher Information Matrix-based Nonlinear System Conversion for State Estimation Fisher Information Matrix-based Nonlinear System Conversion for State Estimation Ming Lei Christophe Baehr and Pierre Del Moral Abstract In practical target tracing a number of improved measurement conversion

More information

X. F. Wang, J. F. Chen, Z. G. Shi *, and K. S. Chen Department of Information and Electronic Engineering, Zhejiang University, Hangzhou , China

X. F. Wang, J. F. Chen, Z. G. Shi *, and K. S. Chen Department of Information and Electronic Engineering, Zhejiang University, Hangzhou , China Progress In Electromagnetics Research, Vol. 118, 1 15, 211 FUZZY-CONTROL-BASED PARTICLE FILTER FOR MANEUVERING TARGET TRACKING X. F. Wang, J. F. Chen, Z. G. Shi *, and K. S. Chen Department of Information

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

Planning With Information States: A Survey Term Project for cs397sml Spring 2002

Planning With Information States: A Survey Term Project for cs397sml Spring 2002 Planning With Information States: A Survey Term Project for cs397sml Spring 2002 Jason O Kane jokane@uiuc.edu April 18, 2003 1 Introduction Classical planning generally depends on the assumption that the

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

Lecture Note 2: Estimation and Information Theory

Lecture Note 2: Estimation and Information Theory Univ. of Michigan - NAME 568/EECS 568/ROB 530 Winter 2018 Lecture Note 2: Estimation and Information Theory Lecturer: Maani Ghaffari Jadidi Date: April 6, 2018 2.1 Estimation A static estimation problem

More information

Bias-Variance Error Bounds for Temporal Difference Updates

Bias-Variance Error Bounds for Temporal Difference Updates Bias-Variance Bounds for Temporal Difference Updates Michael Kearns AT&T Labs mkearns@research.att.com Satinder Singh AT&T Labs baveja@research.att.com Abstract We give the first rigorous upper bounds

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

Introduction p. 1 Fundamental Problems p. 2 Core of Fundamental Theory and General Mathematical Ideas p. 3 Classical Statistical Decision p.

Introduction p. 1 Fundamental Problems p. 2 Core of Fundamental Theory and General Mathematical Ideas p. 3 Classical Statistical Decision p. Preface p. xiii Acknowledgment p. xix Introduction p. 1 Fundamental Problems p. 2 Core of Fundamental Theory and General Mathematical Ideas p. 3 Classical Statistical Decision p. 4 Bayes Decision p. 5

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

ECE531 Lecture 11: Dynamic Parameter Estimation: Kalman-Bucy Filter

ECE531 Lecture 11: Dynamic Parameter Estimation: Kalman-Bucy Filter ECE531 Lecture 11: Dynamic Parameter Estimation: Kalman-Bucy Filter D. Richard Brown III Worcester Polytechnic Institute 09-Apr-2009 Worcester Polytechnic Institute D. Richard Brown III 09-Apr-2009 1 /

More information

MULTI-MODEL FILTERING FOR ORBIT DETERMINATION DURING MANOEUVRE

MULTI-MODEL FILTERING FOR ORBIT DETERMINATION DURING MANOEUVRE MULTI-MODEL FILTERING FOR ORBIT DETERMINATION DURING MANOEUVRE Bruno CHRISTOPHE Vanessa FONDBERTASSE Office National d'etudes et de Recherches Aérospatiales (http://www.onera.fr) B.P. 72 - F-92322 CHATILLON

More information

NONLINEAR SAMPLED-DATA OBSERVER DESIGN VIA APPROXIMATE DISCRETE-TIME MODELS AND EMULATION

NONLINEAR SAMPLED-DATA OBSERVER DESIGN VIA APPROXIMATE DISCRETE-TIME MODELS AND EMULATION NONLINEAR SAMPLED-DAA OBSERVER DESIGN VIA APPROXIMAE DISCREE-IME MODELS AND EMULAION Murat Arcak Dragan Nešić Department of Electrical, Computer, and Systems Engineering Rensselaer Polytechnic Institute

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

On Scalable Distributed Sensor Fusion

On Scalable Distributed Sensor Fusion On Scalable Distributed Sensor Fusion KC Chang Dept. of SEO George Mason University Fairfax, VA 3, USA kchang@gmu.edu Abstract - The theoretic fundamentals of distributed information fusion are well developed.

More information

Gaussian Estimation under Attack Uncertainty

Gaussian Estimation under Attack Uncertainty Gaussian Estimation under Attack Uncertainty Tara Javidi Yonatan Kaspi Himanshu Tyagi Abstract We consider the estimation of a standard Gaussian random variable under an observation attack where an adversary

More information

Towards control over fading channels

Towards control over fading channels Towards control over fading channels Paolo Minero, Massimo Franceschetti Advanced Network Science University of California San Diego, CA, USA mail: {minero,massimo}@ucsd.edu Invited Paper) Subhrakanti

More information

Stochastic Models, Estimation and Control Peter S. Maybeck Volumes 1, 2 & 3 Tables of Contents

Stochastic Models, Estimation and Control Peter S. Maybeck Volumes 1, 2 & 3 Tables of Contents Navtech Part #s Volume 1 #1277 Volume 2 #1278 Volume 3 #1279 3 Volume Set #1280 Stochastic Models, Estimation and Control Peter S. Maybeck Volumes 1, 2 & 3 Tables of Contents Volume 1 Preface Contents

More information

Acommon problem in signal processing is that of estimating

Acommon problem in signal processing is that of estimating IEEE TRANSACTIONS ON SIGNAL PROCESSING, VOL. 59, NO. 5, MAY 2011 1933 Hidden Relationships: Bayesian Estimation With Partial Knowledge Tomer Michaeli and Yonina C. Eldar, Senior Member, IEEE Abstract We

More information

Quadruple Adaptive Redundancy with Fault Detection Estimator

Quadruple Adaptive Redundancy with Fault Detection Estimator Quadruple Adaptive Redundancy with Fault Detection Estimator Dohyeung Kim 1 and Richard Voyles 2 Abstract As a result of advances in technology, systems have grown more and more complex, leading to greater

More information

Multi-Robotic Systems

Multi-Robotic Systems CHAPTER 9 Multi-Robotic Systems The topic of multi-robotic systems is quite popular now. It is believed that such systems can have the following benefits: Improved performance ( winning by numbers ) Distributed

More information

Basics of Uncertainty Analysis

Basics of Uncertainty Analysis Basics of Uncertainty Analysis Chapter Six Basics of Uncertainty Analysis 6.1 Introduction As shown in Fig. 6.1, analysis models are used to predict the performances or behaviors of a product under design.

More information

Diagnosis of Repeated/Intermittent Failures in Discrete Event Systems

Diagnosis of Repeated/Intermittent Failures in Discrete Event Systems Diagnosis of Repeated/Intermittent Failures in Discrete Event Systems Shengbing Jiang, Ratnesh Kumar, and Humberto E. Garcia Abstract We introduce the notion of repeated failure diagnosability for diagnosing

More information

Benjamin L. Pence 1, Hosam K. Fathy 2, and Jeffrey L. Stein 3

Benjamin L. Pence 1, Hosam K. Fathy 2, and Jeffrey L. Stein 3 2010 American Control Conference Marriott Waterfront, Baltimore, MD, USA June 30-July 02, 2010 WeC17.1 Benjamin L. Pence 1, Hosam K. Fathy 2, and Jeffrey L. Stein 3 (1) Graduate Student, (2) Assistant

More information

V Control Distance with Dynamics Parameter Uncertainty

V Control Distance with Dynamics Parameter Uncertainty V Control Distance with Dynamics Parameter Uncertainty Marcus J. Holzinger Increasing quantities of active spacecraft and debris in the space environment pose substantial risk to the continued safety of

More information

FAULT DETECTION AND FAULT TOLERANT APPROACHES WITH AIRCRAFT APPLICATION. Andrés Marcos

FAULT DETECTION AND FAULT TOLERANT APPROACHES WITH AIRCRAFT APPLICATION. Andrés Marcos FAULT DETECTION AND FAULT TOLERANT APPROACHES WITH AIRCRAFT APPLICATION 2003 Louisiana Workshop on System Safety Andrés Marcos Dept. Aerospace Engineering and Mechanics, University of Minnesota 28 Feb,

More information

c 2009 IEEE. Personal use of this material is permitted. Permission from IEEE must be obtained for all other uses, including reprinting/republishing

c 2009 IEEE. Personal use of this material is permitted. Permission from IEEE must be obtained for all other uses, including reprinting/republishing c 2009 IEEE. Personal use of this material is permitted. Permission from IEEE must be obtained for all other uses, including reprinting/republishing this material for advertising or promotional purposes,

More information

Density Approximation Based on Dirac Mixtures with Regard to Nonlinear Estimation and Filtering

Density Approximation Based on Dirac Mixtures with Regard to Nonlinear Estimation and Filtering Density Approximation Based on Dirac Mixtures with Regard to Nonlinear Estimation and Filtering Oliver C. Schrempf, Dietrich Brunn, Uwe D. Hanebeck Intelligent Sensor-Actuator-Systems Laboratory Institute

More information

A Multiple-Observer Scheme for Fault Detection, Isolation and Recovery of Satellite Thrusters

A Multiple-Observer Scheme for Fault Detection, Isolation and Recovery of Satellite Thrusters Proceedings of the EuroGNC 3, nd CEAS Specialist Conference on Guidance, Navigation & Control, Delft University of Technology, Delft, The Netherlands, April -, 3 FrBT.3 A Multiple-Observer Scheme for Fault

More information

Probability Map Building of Uncertain Dynamic Environments with Indistinguishable Obstacles

Probability Map Building of Uncertain Dynamic Environments with Indistinguishable Obstacles Probability Map Building of Uncertain Dynamic Environments with Indistinguishable Obstacles Myungsoo Jun and Raffaello D Andrea Sibley School of Mechanical and Aerospace Engineering Cornell University

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

Adaptive Dynamic Inversion Control of a Linear Scalar Plant with Constrained Control Inputs

Adaptive Dynamic Inversion Control of a Linear Scalar Plant with Constrained Control Inputs 5 American Control Conference June 8-, 5. Portland, OR, USA ThA. Adaptive Dynamic Inversion Control of a Linear Scalar Plant with Constrained Control Inputs Monish D. Tandale and John Valasek Abstract

More information

PARAMETER ESTIMATION AND ORDER SELECTION FOR LINEAR REGRESSION PROBLEMS. Yngve Selén and Erik G. Larsson

PARAMETER ESTIMATION AND ORDER SELECTION FOR LINEAR REGRESSION PROBLEMS. Yngve Selén and Erik G. Larsson PARAMETER ESTIMATION AND ORDER SELECTION FOR LINEAR REGRESSION PROBLEMS Yngve Selén and Eri G Larsson Dept of Information Technology Uppsala University, PO Box 337 SE-71 Uppsala, Sweden email: yngveselen@ituuse

More information