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

Size: px
Start display at page:

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

Transcription

1 Recursive Filtering for Target Tracing with Range and Direction Cosine Measurements Zhansheng Duan Yu Liu X. Rong Li Department of Electrical Engineering University of New Orleans New Orleans, LA 748, U.S.A. Abstract Due to the nonlinear relationship between Cartesian coordinates and range-direction-cosine coordinates, target tracing of state described in Cartesian coordinates with range and direction cosine measurements is a nonlinear filtering problem. Measurement conversion based Kalman filter available for this type of problem has some serious drawbacs. Depending on whether measurement of the third direction cosine is directly available, two recursive linear minimum mean-squared error () filters for target tracing with range and direction cosine measurements are developed in this paper. Illustrative numerical examples show that in terms of credibility and accuracy, the proposed filters should be preferred. Keywords:, target tracing, range, direction cosine, nonlinear filtering. Introduction In tracing applications, target dynamics are usually modeled in Cartesian coordinates, while the measurements are directly available in the original sensor coordinates. Due to the nonlinear relationship between Cartesian coordinates and sensor coordinates, tracing in Cartesian coordinates using measurements available in sensor coordinates is in essence a nonlinear filtering problem. Existing nonlinear filtering algorithms, e.g., extended Kalman filter (EKF) [], unscented filtering () [], the second-order Stirling interpolation based filter (DD) [3], and Gaussian filter [4], for general nonlinear systems can be applied to this problem. But since the nonlinear relationship between the Cartesian coordinates and sensor coordinates is explicitly nown, specifically designed nonlinear filters may behave better. In a trac-while-scan surveillance system, the radar can provide measurements, e.g., range, bearing, elevation and range rate, in polar or spherical coordinates [5]. Specifically designed target tracing algorithms for this type of radar abound. One popular idea is to convert the measurement model in polar or spherical coordinates to Cartesian Research supported in part by NSFC grant 666, ARO through grant W9NF-8--49, ONR-DEPSCoR through grant N , and NAVO through Contract # N636-9-P-3S. coordinates so that the converted measurement model taes a pseudo linear form with respect to the target motion state described in Cartesian coordinates. In this way, it is hoped that the Kalman filter can be applied. Unfortunately, the converted measurement errors are state dependent and have biases. Numerous ways have been proposed to debias the converted measurements [5]. For instance, [6, 7, 8] proposed to use additive debiasing, and [9, ] proposed to use multiplicative debiasing. [] proposed the recursive filter with respect to the converted measurements. [, 3] extended debiased conversion to the case when range rate measurements are also available. For the scan-while-trac surveillance system, such as the phased array radar, the measurements are usually provided in RUV coordinates [5, 4, 5, 6, 7, 8, 9]. That is, what is available is range and two direction cosine measurements. Specifically designed target tracing algorithms for this type of radar are also available. For example, by using the firstorder and second-order Taylor series expansions, [8, ] developed Kalman filters for this type of problem based on debiased measurement conversion. As pointed out in [5, ], the Kalman filter based on debaised conversion of measurement model from polar or spherical coordinates to Cartesian coordinates has the following serious drawbacs. First, the converted measurement errors are state dependent; second, their covariances are estimated conditioned on the measurement or state; third, the converted measurement error sequence is not white any more. However, in the assumptions of the Kalman filter, the measurement noise is independent of the state, its covariance is unconditional, and it is white. These drawbacs cannot be overcome in the existing debiased conversion based methods [6, 7, 8, 9, ]. Since the debiased conversion based Kalman filters in [8, ] follow the same idea, they are not free of these drawbacs either. In this paper, we want to extend the wor in [] to target tracing with range and direction cosine measurements. That is, we want to develop a recursive filter for target tracing in the RUV coordinates. It is shown that the main difficulty to fulfill this goal stems from the lac of direct measurement of the third direction cosine. For the

2 case when the third direction cosine is measured, we propose a neat recursive filter with range and direction cosine measurements; otherwise, by constructing a pseudo measurement of the third direction cosine, we also propose a slightly more complicated recursive filter with range and two directly measured direction cosine measurements. Illustrative examples are provided to compare the proposed filters with some existing algorithms in terms of credibility and estimation accuracy. The paper is organized as follows. Sec. formulates the problem. Sec. 3 presents a recursive filter when the third direction cosine measurement is directly available. Sec. 4 presents a recursive filter when the third direction cosine measurement is not directly available. Sec. 5 provides some illustrative examples. Sec. 6 gives conclusions. Problem formulation To simplify discussion, consider only the following linear target dynamics described in Cartesian coordinates X = F X + G W X = [ x ẋ y ẏ z ż ] is the target state vector at time, W is a zero-mean white noise sequence with covariance Q, E[X ] = X, cov(x ) = P. A radar located at the origin of the Cartesian coordinates measures range r m, two direction cosines um and vm of the target as r = r m = r + n r u m = u + n u () v m = v + n v () x + y + z, u = x /r, v = y /r n r, nu and nv are all zero-mean white noise sequences with variances σr, σ u and σ v, respectively; also, nr, nu and n v are independent of each other, and independent of X and W. The range and two direction cosine measurements can be transformed into x m and ym in the Cartesian coordinates as x m = r m u m = (r + n r )(u + n u ) = x + r n u + u n r + nr nu (3) y m = r m v m = (r + n r )(v + n v ) = y + r n v + v n r + nr nv (4) In this paper, we want to estimate the state as best as we can in the sense. Remar: Note that in the above formulation, we only need to now the first two moments of the measurement noise, while in [, 6, 7, 8, 9, ], distribution of the measurement noise must be nown. For example, it was assumed therein that measurement noise is Gaussian distributed. 3 Recursive filter with measured w m From the appendix of [], it is easy to verify that the following two lemmas hold for estimation. Lemma For a scalar-valued γ, if γ is uncorrelated with x and z, then E [γx z] = E[γ]E [x z] Lemma For estimation error covariance, cov( x) = E[(x ˆx)(x ˆx) ] = E[xx ] E[ˆxˆx ] cov( x, ỹ) = E[(x ˆx)(y ŷ) ] = E[xy ] E[ˆxŷ ] ˆx = E [x z], x = x ˆx ŷ = E [y z], ỹ = y ŷ First, let us consider the case in which the third direction cosine measurement is also available, w m = w + n w w = z /r and n w is a zero-mean white noise sequence with variance σw. Also, n w is statistically independent of nr, nu and n v. Correspondingly in the Cartesian coordinates, we have Denote z m = rm wm = (r + n r )(w + n w ) = z + r n w + w n r + n r n w (5) Z = [ x m y m z m ] Then by the two lemmas above, for the case in which all three direction cosine measurements u m, vm and wm are directly available, the following theorem holds. Theorem ( filter with measured w m). If the third direction cosine measurement w m is also available, given ˆX = E [X Z ], P = MSE( ˆX ), the estimate of X is: Prediction: ˆX = F ˆX P = F P F + G Q G Update: ˆX = ˆX + C S Z P = P C S C

3 Z = Z Ẑ Ẑ = [ ˆX (), ˆX (3), ˆX (5)] C = [P (:, ), P (:, 3), P (:, 5)] S = [S (i, j)] 3 i,j= S (, ) = P (, ) + σ u E[r ] + σ r E[u ] + σ r σ u S (, ) = S (, ) = P (, 3) + σ re[u v ] S (, 3) = S (3, ) = P (, 5) + σ re[u w ] S (, ) = P (3, 3) + σ ve[r ] + σ re[v ] + σ rσ v S (, 3) = S (3, ) = P (3, 5) + σ r E[v w ] S (3, 3) = P (5, 5) + σ w E[r ] + σ r E[w ] + σ r σ w Proof: Given ˆX and P, it follows easily from the property of estimation that ˆX = E [X Z ] = F ˆX P = MSE( ˆX ) = F P F + G Q G The estimator E [X Z ] always has the following quasi-recursive form [] ˆX = E [X Z ] = E [X Z, Z ] Z = ˆX + C S P = MSE( ˆX ) = P C S C From Lemma and the property of estimation, we have Ẑ = E [Z Z ] = [E [x m Z ], E [y m Z ], E [z m Z ]] E [x m Z ] = E [x + r n u + u n r + nr nu Z ] and similarly, = E [x Z ] = ˆx = ˆX () E [y m Z ] = ŷ = ˆX (3) E [z m Z ] = ẑ = ˆX (5) From Lemma, we have C = cov( X, Z ) = E[X Z ] E[ ˆX Ẑ ] x x m x y m x z m ẋ x m ẋ y m ẋ z m = E y x m y y m y z m ẏ x m ẏ y m ẏ z m z x m z y m z z m ż x m ż y m ż z m ˆx ˆx ˆx ŷ ˆx ẑ ẋ ˆx ẋ ŷ ẋ ẑ E ŷ ˆx ŷ ŷ ŷ ẑ ẏ ˆx ẏ ŷ ẏ ẑ ẑ ˆx ẑ ŷ ẑ ẑ ż ˆx ż ŷ ż ẑ E[x x m ] = E[x (x + r n u + u n r + n r n u )] = E[x x ] and similarly, E[x y m ] = E[x y ], E[x z m ] = E[x z ] E[ẋ x m ] = E[ẋ x ], E[ẋ y m ] = E[ẋ y ], E[ẋ z m ] = E[ẋ z ] E[y x m ] = E[y x ], E[y y m ] = E[y y ], E[y z m ] = E[y z ] E[ẏ x m ] = E[ẏ x ], E[ẏ y m ] = E[ẏ y ], E[ẏ z m ] = E[ẏ z ] E[z x m ] = E[z x ], E[z y m ] = E[z y ], E[z z m ] = E[z z ] E[ż x m ] = E[ż x ], E[ż y m ] = E[ż y ], E[ż z m ] = E[ż z ] Thus C = [P (:, ), P (:, 3), P (:, 5)] Furthermore, from Lemma, we have S = cov( Z ) = E[Z Z ] E[Ẑ Ẑ ] = E xm xm x m ym x m zm y mxm y mym y mzm z mxm z mym z mzm E ˆx ˆx ˆx ŷ ˆx ẑ ŷ ˆx ŷ ŷ ŷ ẑ ẑ ˆx ẑ ŷ ẑ ẑ E[x m xm ] = E[(x + r n u + u n r + n r n u )( )] = E[x x ] + E[r (nu ) ] + E[u (nr ) ] + E[(n r ) (n u ) ] = E[x x ] + σ u E[r ] + σ r E[u ] + σ r σ u and similarly, E[x m ym ] = E[ym xm ] = E[x y ] + σ r E[u v ] E[x m z m ] = E[z m x m ] = E[x z ] + σ re[u w ] E[y m y m ] = E[y y ] + σ ve[r ] + σ re[v ] + σ rσ v E[y m z m ] = E[z m y m ] = E[y z ] + σ re[v w ] E[z m zm ] = E[z z ] + σ w E[r ] + σ r E[w ] + σ r σ w

4 Thus S (, ) = P (, ) + σ ue[r ] + σ re[u ] + σ rσ u S (, ) = S (, ) = P (, 3) + σ re[u v ] S (, 3) = S (3, ) = P (, 5) + σ re[u w ] S (, ) = P (3, 3) + σ v E[r ] + σ r E[v ] + σ r σ v S (, 3) = S (3, ) = P (3, 5) + σ r E[v w ] S (3, 3) = P (5, 5) + σ w E[r ] + σ r E[w ] + σ r σ w Remar: Since r, u, v and w are all nonlinear functions of X, the expectations E[r ], E[u ], E[v ], E[w ], E[u v ], E[u w ] and E[v w ] in Theorem can be approximated by unscented transformation (UT). Only the UT for E[r ] is shown below for illustration, and the others can be done similarly. E[r ] = E[x + y + z ] 6 α (j) ((X (j) ()) + (X (j) (3)) + (X (j) (5)) ) X () α () = j= 6 = ˆX, X (±i) = ˆX ± [((6 + κ)p ) ]i κ 6 + κ, α(±i) =, i =,,, 6 (6 + κ) [A ] i is the i-th column of the Cholesy decomposition of square matrix A. The design parameter κ provides an extra degree of freedom to fine tune the higher order moments of the approximation and κ can be any number (positive or negative) provided that 6 + κ. 4 Recursive filter without measured w m As described in the problem formulation part, w m is usually not measured in the current radar. This maes the corresponding estimation problem much harder. One popular way is to construct a pseudo measurement by w m = (u m ) (v m) (6) = (u + n u ) (v + n v ) Then the range and direction cosine measurements can be transformed to x m, ym and zm in the Cartesian coordinates, as in (3), (4) and (5), with w m replaced by (6) so that z m = rm wm = (r + n r ) (u + n u ) (v + n v ) = r (u + n u ) (v + n v ) + n r (u + n u ) (v + n v ) Denote Z = [ x m y m z m ] Then for the case without measured w m, the following theorem holds. Theorem ( filter without measured w m ). If the third direction cosine measurement w m is not available, given ˆX = E [X Z ], P = MSE( ˆX ), the estimator of X is: Prediction: Same as in filter with measured w m. Update: Same as in filter with measured w m except that Ẑ = [ ˆX (), ˆX (3), ẑ m ] C = [P (:, ), P (:, 3), C ( 3) ] S ( :, 3) = S (3, :) = S ( 3) ẑ m = E [r (u + n u ) (v + n v ) Z ] C ( 3) = E[(X ˆX )(z m ẑm )] S ( 3) = E[(Z Ẑ )(z m ẑm )] Proof: From Lemma and the property of estimation, we have Ẑ (3) = E [z m Z ] = ẑ m = E [r (u + n u ) (v + n v ) + n r (u + n u ) (v + n v ) Z ] = E [r (u + n u ) (v + n v ) Z ] From Lemma, we have C ( :, 3) = cov[ X, z m ] = C ( 3) = E[(X ˆX )(z m ẑm )] S ( :, 3) = S (3, :) = cov[ Z, z m ] = S ( 3) = E[(Z Ẑ )(z m ẑm )] Remar: In Theorem, E[r ], E[u ], E[v ] and E[u v ] can be approximated in the same way as in Theorem. Remar: Since w m is not directly measured in this case, ẑ m does not have a nice form as in Theorem. It can be approximated by some moment matching techniques [], e.g., UT, as ẑ m = E [r (u + n u ) (v + n v ) Z ] 9 j= 9 β(j) z (j)

5 z (j) r (j) = u (j) v (j) β () = = r (j) (u (j) (Y (j) = Y (j) ()/r(j) = Y (j) + Y(j) (8)) (v (j) + Y (j) (9)) ()) + (Y (j) (3)) + (Y (j) (5)) (3)/r(j), j = ±9, ±8,, κ 9 + κ, β(±i) = (9 + κ), Y() = Y Y (±i) = Y ± [((9 + κ)c ) ]i, i =,,, 9 Y = [ ˆX,,, ], C = diag(p, σ r, σ u, σ v ) And correspondingly, C ( 3) 9 β (j) (Y j ( : 6) ˆX )(z (j) ẑ m ) j= 9 S ( 3) 9 j= 9 βj (Z (j) (j) Ẑ )(z ẑ m ) Z (j) x (j) y (j) = [ x (j) = Y (j) y (j) () + r(j) z (j) ] Y(j) + Y (j) (7)Y(j) (8) = Y (j) (3) + r(j) + Y (j) (7)Y(j) (9) Y(j) (8) + u(j) (9) + v(j) Y(j) Y(j) (7) (7) Remar: Other moment matching techniques [], e.g., DD [3], can also be used to replace UT. 5 Illustrative examples In this section, we compare performance of the proposed recursive filter with measured w m (w), the proposed recursive filter without measured w m (),, converted measurement Kalman filter with CM (CMKF) [] and converted measurement Kalman filter with CM () [] in terms of estimation accuracy and credibility through numerical examples. Except w, all the other filters are assumed to have no access to the measured w m. Consider the following three-dimensional discrete-time constant velocity (CV) motion model [3] of a target X = F X + G W X = [ x ẋ y ẏ z ż ], X N( X, P ) F = diag(f, F, F), G = diag(g, G, G) [ ] [ ] T T F =, G = /, T = s T W N([ ], diag((q x ), (q y ), (q z ) )) The estimation accuracy measures used are root meansquared (RMS) position and velocity errors. The filter credibility measures used are average normalized estimation error squared (ANEES) and noncredibility index (NCI) [4]. All results below are averaged over 5 Monte Carlo runs. All filters are initialized with and ˆX = X, P = P X = [ 33m 6m/s 33m 6m/s 33m 6m/s ] P = diag( 4 m, m /s, 4 m, m /s, 4 m, m /s ) σ u = σ v = σ w = 3, q x = q y = qz =.5m/s Figs. through 4 show comparison results for the case with σ r = m (case ). In this case, the range measurement accuracy is the poorest among all three cases. From the simulation results, it can be seen that in terms of both RMS position and velocity errors, there is no significant difference among CMKF,, and. LMM- SEw has the smallest RMS position error. In terms of RMS velocity error, w outperforms all the others during steady state but is worse than all the others during transient. It terms of filter credibility, all filters are credible. RMS position error(m) CMKF w Figure : RMS position error comparison for case. Note that, CMKF, and essentially overlap with each other except that CMKF is slightly worse than the other three. Figs. 5 through 8 show comparison results for the case with σ r = m (case ). In this case, the range measurement accuracy is relatively better. From the simulation results, it can be seen that in terms of estimation accuracy, CMKF is the worst except it beats w in velocity slightly during transient. Our beats clearly but beats only slightly. In terms of RMS velocity error, there is no significant difference among,

6 RMS velocity error(m/s) CMKF w NCI w..4. Figure : RMS velocity error comparison for case. Note that, CMKF, and essentially overlap with each other. ANEES w RMS position error(m) Figure 4: NCI comparison for case CMKF w.9 Figure 3: ANEES comparison for case Figure 5: RMS position error comparison for case. Note that and essentially overlap with each other except that is slightly better than. and. Our w beats all the others significantly in RMS position error. In terms of filter credibility, CMKF is far from credible. (The ANEES and NCI of CMKF are not shown because they are much larger than those of the other filters.) is barely credible and all the others are credible. Figs. 9 through show comparison results for the case with σ r = m (case 3). In this case, the range measurement accuracy is the best. From the simulation results, it can be seen that in terms of estimation accuracy, the difference between CMKF and all the others is increased a lot when compared with case. Over all three cases, it can be seen that in terms of both estimation accuracy and filter credibility, w beats all the others. Considering both this performance improvement and simplicity of the recursive filter with measured w m, it is highly desirable to have wm in the same way (signal processing mechanism) as u m and vm in () and () instead of using the pseudo measurement in (6) in the phased array radar. Although our has very close estima- tion accuracy to those of and, its filter credibility is much better. 6 Conclusions For a scan-while-trac surveillance system, such as a phased array radar, the available measurements are usually range and direction cosine. To trac the state of a moving target described in the Cartesian coordinates, one existing approach is to convert the range and direction cosine measurement model to Cartesian coordinates so that the converted measurement model taes a pseudo linear form with respect to the state, but it has some serious drawbacs. The main difficulty to develop a recursive filter for this type of problem stems from the lac of direct measurement of the third direction cosine. For the case when the third direction cosine can be directly measured, we have proposed a neat recursive filter; otherwise, by constructing a pseudo measurement of the third direction cosine, we have also proposed a slightly more complicated recursive filter.

7 CMKF w 3.5 RMS velocity error(m/s) NCI.5 w.4..5 Figure 6: RMS velocity error comparison for case. Note that, and essentially overlap with each other except that is slightly better than and is slightly better than. ANEES w RMS position error(m) Figure 8: NCI comparison for case CMKF w.8 Figure 7: ANEES comparison for case Illustrative numerical examples have shown that in terms of credibility and accuracy, the proposed filters are preferred. References [] R. K. Mehra, A comparison of several nonlinear filters for reentry vehicle tracing, IEEE Transactions on Automatic Control, vol. 6, no. 4, pp , August 97. [] S. Julier, J. Uhlmann, and H. F. Durrant-Whyte, A new method for nonlinear transformation of means and covariances in filters and estimators, IEEE Transactions on Automatic Control, vol. 45, no. 3, pp , March. [3] M. Norgaard, N. K. Poulsen, and O. Ravn, New developments in state estimation for nonlinear systems, Automatica, vol. 36, no., pp , November. [4] K. Ito and K. Q. Xiong, Gaussian filters for nonlinear filtering problems, IEEE Transactions on Automatic Control, vol. 45, no. 5, pp. 9 97, May. [5] X. R. Li and V. P. Jilov, A survey of maneuvering target tracing - part III: Measurement models, in Proceedings of Figure 9: RMS position error comparison for case 3. Note that is slightly better than. SPIE Conference on Signal and Data Processing of Small Targets, vol. 4473, San Diego, CA, July-August, pp. 4. [6] D. Lerro and Y. Bar-Shalom, Tracing with debiased consistent converted measurements versus ef, IEEE Transactions on Aerospace and Electronic Systems, vol. 9, no. 3, pp. 5, July 993. [7] P. Suchomsi, Explicit expressions for debiased statistics of 3d converted measurements, IEEE Transactions on Aerospace and Electronic Systems, vol. 35, no., pp , January 999. [8] S. T. Par and J. G. Lee, Improved alman filter design for three-dimensional radar tracing, IEEE Transactions on Aerospace and Electronic Systems, vol. 37, no., pp , April. [9] L. B. Mo, X. Q. Song, Y. Y. Zhou, Z. K. Sun, and Y. Bar- Shalom, Unbiased converted measurements for tracing, IEEE Transactions on Aerospace and Electronic Systems, vol. 34, no. 3, pp. 3 7, July 998. [] Z. S. Duan, C. Z. Han, and X. R. Li, Comments on unbiased converted measurements for tracing, IEEE Transac-

8 RMS velocity error(m/s) CMKF w NCI w.5.5 Figure : RMS velocity error comparison for case 3. Note that, and essentially overlap with each other. ANEES w.8 Figure : ANEES comparison for case 3 tions on Aerospace and Electronic Systems, vol. 4, no. 4, pp , October 4. [] Z. L. Zhao, X. R. Li, and V. P. Jilov, Best linear unbiased filtering with nonlinear measurements for target tracing, IEEE Transactions on Aerospace and Electronic Systems, vol. 4, no. 4, pp , October 4. [] J. G. Wang, P. K. He, and T. Long, Use of the radial velocity measurement in target tracing, IEEE Transactions on Aerospace and Electronic Systems, vol. 39, no., pp. 4 43, April 3. [3] Z. S. Duan, C. Z. Han, and X. R. Li, Sequential nonlinear tracing filter with range-rate measurements in spherical coordinates, in Proceedings of the 7th International Conference on Information Fusion, vol., Stocholm, Sweden, June 4, pp [4] Y. Kosuge, H. Iwama, and Y. Miyazai, A tracing filter for phased array radar with range rate measurement, in Proceedings of 99 International Conference on Industrial Electronics, Control and Instrumentation, vol. 3, Kobe, October 99, pp Figure : NCI comparison for case 3 [5] H. J. Shin, S. M. Hong, and D. H. Hong, Adaptive-updaterate target tracing for phased-array radar, IEE Proceedings - Radar, Sonar and Navigation, vol. 4, no. 3, pp , June 995. [6] P. Minvielle, Decades of improvements in re-entry ballistic vehicle tracing, IEEE Aerospace and Electronic Systems Magazine, vol., no. 8, pp. CF/ CF4, August 5. [7] F. Daum and R. Fitzgerald, Decoupled alman filters for phased array radar tracing, IEEE Transactions on Automatic Control, vol. 8, no. 3, pp , March 983. [8] G. van Keu, Multihypothesis tracing with electronically scanned radar, IEEE Transactions on Aerospace and Electronic Systems, vol. 3, no. 3, pp , July 995. [9] S. M. Hong and Y. H. Jung, Optimal scheduling of trac updates in phased array radars, IEEE Transactions on Aerospace and Electronic Systems, vol. 34, no. 3, pp. 6, July 998. [] X. Tian and Y. Bar-Shalom, Coordinate conversion and tracing for very long range radars, IEEE Transactions on Aerospace and Electronic Systems, vol. 45, no. 3, pp , July 9. [] X. R. Li, Recursibility and optimal linear estimation and filtering, in Proceedings of the 43rd IEEE Conference on Decision and Control, Atlantis, Paradise Island, Bahamas, December 4, pp [] X. R. Li and V. P. Jilov, A survey of maneuvering target tracing - part III: Approximation techniques for nonlinear filtering, in Proceedings of 4 SPIE Conference on Signal and Data Processing of Small Targets, vol. 548, San Diego, CA, April 4, pp [3], Survey of maneuvering target tracing. part I: Dynamic models, IEEE Transactions on Aerospace and Electronic Systems, vol. 39, no. 4, pp , October 3. [4] X. R. Li and Z. L. Zhao, Measuring estimator s credibility: Noncredibility index, in Proceedings of the 9th International Conference on Information Fusion, Florence, Italy, July 6, pp. 8.

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

Optimal Linear Unbiased Filtering with Polar Measurements for Target Tracking Λ

Optimal Linear Unbiased Filtering with Polar Measurements for Target Tracking Λ Optimal Linear Unbiased Filtering with Polar Measurements for Target Tracking Λ Zhanlue Zhao X. Rong Li Vesselin P. Jilkov Department of Electrical Engineering, University of New Orleans, New Orleans,

More information

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

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

More information

Randomized Unscented Kalman Filter in Target Tracking

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

More information

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

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

More information

Generalized Linear Minimum Mean-Square Error Estimation

Generalized Linear Minimum Mean-Square Error Estimation Generalized Linear Minimum Mean-Square Error Estimation Yu Liu and X. Rong Li Department of Electrical Engineering University of New Orleans New Orleans, LA 7148, U.S.A. Email: {lyu2, xli}@uno.edu Abstract

More information

Optimal Distributed Estimation Fusion with Compressed Data

Optimal Distributed Estimation Fusion with Compressed Data 12th International Conference on Information Fusion Seattle, WA, USA, July 6-9, 2009 Optimal Distributed Estimation Fusion with Compressed Data Zhansheng Duan X. Rong Li Department of Electrical Engineering

More information

The Scaled Unscented Transformation

The Scaled Unscented Transformation The Scaled Unscented Transformation Simon J. Julier, IDAK Industries, 91 Missouri Blvd., #179 Jefferson City, MO 6519 E-mail:sjulier@idak.com Abstract This paper describes a generalisation of the unscented

More information

Extended Object and Group Tracking with Elliptic Random Hypersurface Models

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

More information

Constrained Target Motion Modeling Part I: Straight Line Track

Constrained Target Motion Modeling Part I: Straight Line Track Constrained Target Motion Modeling Part I: Straight Line Trac Zhansheng Duan Center for Information Engineering Science Research Xi an Jiaotong University Xi an, Shaanxi 749, China Email: zduan@uno.edu

More information

SIGMA POINT GAUSSIAN SUM FILTER DESIGN USING SQUARE ROOT UNSCENTED FILTERS

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

More information

A New Nonlinear Filtering Method for Ballistic Target Tracking

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

More information

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

A new unscented Kalman filter with higher order moment-matching

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

More information

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

Nonlinear Estimation Techniques for Impact Point Prediction of Ballistic Targets

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

More information

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 4: Least Squares (LS) Estimation

Lecture 4: Least Squares (LS) Estimation ME 233, UC Berkeley, Spring 2014 Xu Chen Lecture 4: Least Squares (LS) Estimation Background and general solution Solution in the Gaussian case Properties Example Big picture general least squares estimation:

More information

Ground Moving Target Parameter Estimation for Stripmap SAR Using the Unscented Kalman Filter

Ground Moving Target Parameter Estimation for Stripmap SAR Using the Unscented Kalman Filter Ground Moving Target Parameter Estimation for Stripmap SAR Using the Unscented Kalman Filter Bhashyam Balaji, Christoph Gierull and Anthony Damini Radar Sensing and Exploitation Section, Defence Research

More information

Distributed Kalman Filtering in the Presence of Packet Delays and Losses

Distributed Kalman Filtering in the Presence of Packet Delays and Losses Distributed Kalman Filtering in the Presence of Pacet Delays and Losses Marc Reinhardt, Benjamin Noac, Sanjeev Kularni, and Uwe D. Hanebec Intelligent Sensor-Actuator-Systems Laboratory (ISAS) Institute

More information

State Estimation with Nonlinear Inequality Constraints Based on Unscented Transformation

State Estimation with Nonlinear Inequality Constraints Based on Unscented Transformation 14th International Conference on Information Fusion Chicago, Illinois, USA, Jul 5-8, 2011 State Estimation with Nonlinear Inequalit Constraints Based on Unscented Transformation Jian Lan Center for Information

More information

Extension of the Sparse Grid Quadrature Filter

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

More information

A comparative study of multiple-model algorithms for maneuvering target tracking

A comparative study of multiple-model algorithms for maneuvering target tracking A comparative study of multiple-model algorithms for maneuvering target tracing Ryan R. Pitre Vesselin P. Jilov X. Rong Li Department of Electrical Engineering University of New Orleans New Orleans, LA

More information

State Estimation with Unconventional and Networked Measurements

State Estimation with Unconventional and Networked Measurements University of New Orleans ScholarWors@UNO University of New Orleans Theses and Dissertations Dissertations and Theses 5-14-2010 State Estimation with Unconventional and Networed Measurements Zhansheng

More information

Tracking an Accelerated Target with a Nonlinear Constant Heading Model

Tracking an Accelerated Target with a Nonlinear Constant Heading Model Tracking an Accelerated Target with a Nonlinear Constant Heading Model Rong Yang, Gee Wah Ng DSO National Laboratories 20 Science Park Drive Singapore 118230 yrong@dsoorgsg ngeewah@dsoorgsg Abstract This

More information

NONLINEAR BAYESIAN FILTERING FOR STATE AND PARAMETER ESTIMATION

NONLINEAR BAYESIAN FILTERING FOR STATE AND PARAMETER ESTIMATION NONLINEAR BAYESIAN FILTERING FOR STATE AND PARAMETER ESTIMATION Kyle T. Alfriend and Deok-Jin Lee Texas A&M University, College Station, TX, 77843-3141 This paper provides efficient filtering algorithms

More information

Reduced Sigma Point Filters for the Propagation of Means and Covariances Through Nonlinear Transformations

Reduced Sigma Point Filters for the Propagation of Means and Covariances Through Nonlinear Transformations 1 Reduced Sigma Point Filters for the Propagation of Means and Covariances Through Nonlinear Transformations Simon J. Julier Jeffrey K. Uhlmann IDAK Industries 91 Missouri Blvd., #179 Dept. of Computer

More information

Information Formulation of the UDU Kalman Filter

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

More information

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

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

NON-LINEAR NOISE ADAPTIVE KALMAN FILTERING VIA VARIATIONAL BAYES

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

More information

Tracking of Extended Object or Target Group Using Random Matrix Part I: New Model and Approach

Tracking of Extended Object or Target Group Using Random Matrix Part I: New Model and Approach Tracing of Extended Object or Target Group Using Random Matrix Part I: New Model and Approach Jian Lan Center for Information Engineering Science Research School of Electronics and Information Engineering

More information

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

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

More information

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

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

More information

The Mixed Labeling Problem in Multi Target Particle Filtering

The Mixed Labeling Problem in Multi Target Particle Filtering The Mixed Labeling Problem in Multi Target Particle Filtering Yvo Boers Thales Nederland B.V. Haasbergerstraat 49, 7554 PA Hengelo, The Netherlands yvo.boers@nl.thalesgroup.com Hans Driessen Thales Nederland

More information

Fuzzy Inference-Based Dynamic Determination of IMM Mode Transition Probability for Multi-Radar Tracking

Fuzzy Inference-Based Dynamic Determination of IMM Mode Transition Probability for Multi-Radar Tracking Fuzzy Inference-Based Dynamic Determination of IMM Mode Transition Probability for Multi-Radar Tracking Yeonju Eun, Daekeun Jeon CNS/ATM Team, CNS/ATM and Satellite Navigation Research Center Korea Aerospace

More information

The Shifted Rayleigh Filter for 3D Bearings-only Measurements with Clutter

The Shifted Rayleigh Filter for 3D Bearings-only Measurements with Clutter The Shifted Rayleigh Filter for 3D Bearings-only Measurements with Clutter Attila Can Özelçi EEE Department Imperial College London, SW7 BT attila.ozelci@imperial.ac.uk Richard Vinter EEE Department Imperial

More information

Minimizing Bearing Bias in Tracking By De-coupled Rotation and Translation Estimates

Minimizing Bearing Bias in Tracking By De-coupled Rotation and Translation Estimates Minimizing Bearing Bias in Tracking By De-coupled Rotation and Translation Estimates Raman Arora Department of Electrical Engineering University of Washington Seattle, WA 9895 Email: rmnarora@u.washington.edu

More information

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

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

More information

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

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

More information

Data Assimilation for Dispersion Models

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

More information

Optimal Gaussian Filtering for Polynomial Systems Applied to Association-free Multi-Target Tracking

Optimal Gaussian Filtering for Polynomial Systems Applied to Association-free Multi-Target Tracking 4th International Conference on Information Fusion Chicago, Illinois, USA, July 5-8, Optimal Gaussian Filtering for Polynomial Systems Applied to Association-free Multi-Target Tracking Marcus Baum, Benjamin

More information

A Tree Search Approach to Target Tracking in Clutter

A Tree Search Approach to Target Tracking in Clutter 12th International Conference on Information Fusion Seattle, WA, USA, July 6-9, 2009 A Tree Search Approach to Target Tracking in Clutter Jill K. Nelson and Hossein Roufarshbaf Department of Electrical

More information

A Novel Maneuvering Target Tracking Algorithm for Radar/Infrared Sensors

A Novel Maneuvering Target Tracking Algorithm for Radar/Infrared Sensors Chinese Journal of Electronics Vol.19 No.4 Oct. 21 A Novel Maneuvering Target Tracking Algorithm for Radar/Infrared Sensors YIN Jihao 1 CUIBingzhe 2 and WANG Yifei 1 (1.School of Astronautics Beihang University

More information

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

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

More information

Adaptive Cubature Strong Tracking Information Filter Using Variational Bayesian Method

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

More information

Tactical Ballistic Missile Tracking using the Interacting Multiple Model Algorithm

Tactical Ballistic Missile Tracking using the Interacting Multiple Model Algorithm Tactical Ballistic Missile Tracking using the Interacting Multiple Model Algorithm Robert L Cooperman Raytheon Co C 3 S Division St Petersburg, FL Robert_L_Cooperman@raytheoncom Abstract The problem of

More information

Previously on TT, Target Tracking: Lecture 2 Single Target Tracking Issues. Lecture-2 Outline. Basic ideas on track life

Previously on TT, Target Tracking: Lecture 2 Single Target Tracking Issues. Lecture-2 Outline. Basic ideas on track life REGLERTEKNIK Previously on TT, AUTOMATIC CONTROL Target Tracing: Lecture 2 Single Target Tracing Issues Emre Özan emre@isy.liu.se Division of Automatic Control Department of Electrical Engineering Linöping

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

GMTI Tracking in the Presence of Doppler and Range Ambiguities

GMTI Tracking in the Presence of Doppler and Range Ambiguities 14th International Conference on Information Fusion Chicago, Illinois, USA, July 5-8, 2011 GMTI Tracing in the Presence of Doppler and Range Ambiguities Michael Mertens Dept. Sensor Data and Information

More information

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

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

More information

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

Application of Unscented Transformation for Nonlinear State Smoothing

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

More information

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

Minimum Necessary Data Rates for Accurate Track Fusion

Minimum Necessary Data Rates for Accurate Track Fusion Proceedings of the 44th IEEE Conference on Decision Control, the European Control Conference 005 Seville, Spain, December -5, 005 ThIA0.4 Minimum Necessary Data Rates for Accurate Trac Fusion Barbara F.

More information

SQUARE-ROOT CUBATURE-QUADRATURE KALMAN FILTER

SQUARE-ROOT CUBATURE-QUADRATURE KALMAN FILTER Asian Journal of Control, Vol. 6, No. 2, pp. 67 622, March 204 Published online 8 April 203 in Wiley Online Library (wileyonlinelibrary.com) DOI: 0.002/asjc.704 SQUARE-ROO CUBAURE-QUADRAURE KALMAN FILER

More information

Tracking of Extended Objects and Group Targets using Random Matrices A New Approach

Tracking of Extended Objects and Group Targets using Random Matrices A New Approach Tracing of Extended Objects and Group Targets using Random Matrices A New Approach Michael Feldmann FGAN Research Institute for Communication, Information Processing and Ergonomics FKIE D-53343 Wachtberg,

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

Systematic Error Modeling and Bias Estimation

Systematic Error Modeling and Bias Estimation sensors Article Systematic Error Modeling and Bias Estimation Feihu Zhang * and Alois Knoll Robotics and Embedded Systems, Technische Universität München, 8333 München, Germany; knoll@in.tum.de * Correspondence:

More information

The Kernel-SME Filter with False and Missing Measurements

The Kernel-SME Filter with False and Missing Measurements The Kernel-SME Filter with False and Missing Measurements Marcus Baum, Shishan Yang Institute of Computer Science University of Göttingen, Germany Email: marcusbaum, shishanyang@csuni-goettingende Uwe

More information

Incorporating Track Uncertainty into the OSPA Metric

Incorporating Track Uncertainty into the OSPA Metric 14th International Conference on Information Fusion Chicago, Illinois, USA, July 5-8, 211 Incorporating Trac Uncertainty into the OSPA Metric Sharad Nagappa School of EPS Heriot Watt University Edinburgh,

More information

A Comparison of Multiple-Model Target Tracking Algorithms

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

More information

The Unscented Particle Filter

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

More information

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

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

More information

TARGET TRACKING BY USING PARTICLE FILTER IN SENSOR NETWORKS

TARGET TRACKING BY USING PARTICLE FILTER IN SENSOR NETWORKS TARGET TRACKING BY USING PARTICLE FILTER IN SENSOR NETWORKS D. Gu and H. Hu Department of Computing and Electronic Systems University of Essex, UK Abstract This paper presents a distributed particle filter

More information

Wind-field Reconstruction Using Flight Data

Wind-field Reconstruction Using Flight Data 28 American Control Conference Westin Seattle Hotel, Seattle, Washington, USA June 11-13, 28 WeC18.4 Wind-field Reconstruction Using Flight Data Harish J. Palanthandalam-Madapusi, Anouck Girard, and Dennis

More information

Gaussian Mixtures Proposal Density in Particle Filter for Track-Before-Detect

Gaussian Mixtures Proposal Density in Particle Filter for Track-Before-Detect 12th International Conference on Information Fusion Seattle, WA, USA, July 6-9, 29 Gaussian Mixtures Proposal Density in Particle Filter for Trac-Before-Detect Ondřej Straa, Miroslav Šimandl and Jindřich

More information

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

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

More information

On Continuous-Discrete Cubature Kalman Filtering

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

More information

A New Approach for Doppler-only Target Tracking

A New Approach for Doppler-only Target Tracking A New Approach for Doppler-only Target Tracking G. Battistelli, L. Chisci, C. Fantacci DINFO, Università di Firenze, Florence, Italy {giorgio.battistelli, luigi.chisci, claudio.fantacci}@unifi.it A. Farina,

More information

Linear Prediction Theory

Linear Prediction Theory Linear Prediction Theory Joseph A. O Sullivan ESE 524 Spring 29 March 3, 29 Overview The problem of estimating a value of a random process given other values of the random process is pervasive. Many problems

More information

EKF/UKF Maneuvering Target Tracking using Coordinated Turn Models with Polar/Cartesian Velocity

EKF/UKF Maneuvering Target Tracking using Coordinated Turn Models with Polar/Cartesian Velocity EKF/UKF Maneuvering Target Tracking using Coordinated Turn Models with Polar/Cartesian Velocity Michael Roth, Gustaf Hendeby, and Fredrik Gustafsson Dept. Electrical Engineering, Linköping University,

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

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

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

More information

City, University of London Institutional Repository

City, University of London Institutional Repository City Research Online City, University of London Institutional Repository Citation: Zhao, S., Shmaliy, Y. S., Khan, S. & Liu, F. (2015. Improving state estimates over finite data using optimal FIR filtering

More information

COMPARISON OF SEVERAL NON- LINEAR FILTERS FOR A BENCH- MARK TRACKING PROBLEM

COMPARISON OF SEVERAL NON- LINEAR FILTERS FOR A BENCH- MARK TRACKING PROBLEM AIAA 006-643 COMPARISON OF SEVERAL NON- LINEAR FILTERS FOR A BENCH- MARK TRACKING PROBLEM Christopher D. Karlgaard Analytical Mechanics Associates, Inc., Hampton, VA 3666 and Hanspeter Schaub Virginia

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

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

Acceptance probability of IP-MCMC-PF: revisited

Acceptance probability of IP-MCMC-PF: revisited Acceptance probability of IP-MCMC-PF: revisited Fernando J. Iglesias García, Mélanie Bocquel, Pranab K. Mandal, and Hans Driessen. Sensors Development System Engineering, Thales Nederland B.V. Hengelo,

More information

Summary of Past Lectures. Target Tracking: Lecture 4 Multiple Target Tracking: Part I. Lecture Outline. What is a hypothesis?

Summary of Past Lectures. Target Tracking: Lecture 4 Multiple Target Tracking: Part I. Lecture Outline. What is a hypothesis? REGLERTEKNIK Summary of Past Lectures AUTOMATIC COROL Target Tracing: Lecture Multiple Target Tracing: Part I Emre Özan emre@isy.liu.se Division of Automatic Control Department of Electrical Engineering

More information

1 Kalman Filter Introduction

1 Kalman Filter Introduction 1 Kalman Filter Introduction You should first read Chapter 1 of Stochastic models, estimation, and control: Volume 1 by Peter S. Maybec (available here). 1.1 Explanation of Equations (1-3) and (1-4) Equation

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

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

A Robust Extended Kalman Filter for Discrete-time Systems with Uncertain Dynamics, Measurements and Correlated Noise

A Robust Extended Kalman Filter for Discrete-time Systems with Uncertain Dynamics, Measurements and Correlated Noise 2009 American Control Conference Hyatt Regency Riverfront, St. Louis, MO, USA June 10-12, 2009 WeC16.6 A Robust Extended Kalman Filter for Discrete-time Systems with Uncertain Dynamics, Measurements and

More information

A Theoretical Overview on Kalman Filtering

A Theoretical Overview on Kalman Filtering A Theoretical Overview on Kalman Filtering Constantinos Mavroeidis Vanier College Presented to professors: IVANOV T. IVAN STAHN CHRISTIAN Email: cmavroeidis@gmail.com June 6, 208 Abstract Kalman filtering

More information

Consistent Unbiased Linear Filtering with Polar Measurements

Consistent Unbiased Linear Filtering with Polar Measurements Consistent Unbiased Linear Filtering Polar Measurements Dietrich Fränken Data Fusion Algorithms & Software EADS Deutschl GmbH D-8977 Ulm, Germany Email: dietrich.fraenken@eads.com Abstract The problem

More information

Nonlinear State Estimation! Particle, Sigma-Points Filters!

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

More information

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

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 Kalman Filter Kalman Filter Predict: 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 Update: K = P k k 1 Hk T (H k P k k 1 Hk T + R) 1 x k k = x k k 1 + K(z k H k x k k 1 ) P k k =(I

More information

ARIMA Modelling and Forecasting

ARIMA Modelling and Forecasting ARIMA Modelling and Forecasting Economic time series often appear nonstationary, because of trends, seasonal patterns, cycles, etc. However, the differences may appear stationary. Δx t x t x t 1 (first

More information

A Track-to-Track Fusion Method via Construction of Cross-Covariance Matrix for Tracks with Unknown Correlations

A Track-to-Track Fusion Method via Construction of Cross-Covariance Matrix for Tracks with Unknown Correlations A Track-to-Track Fusion Method via onstruction of ross-ovariance Matrix for Tracks with Unknown orrelations Mahboubeh Zarei-Jalalabadi a,b,, Solmaz S. Kia b, Seyed Mohammad-Bagher Malaek a a Aerospace

More information

A NEW FORMULATION OF IPDAF FOR TRACKING IN CLUTTER

A NEW FORMULATION OF IPDAF FOR TRACKING IN CLUTTER A NEW FRMULATIN F IPDAF FR TRACKING IN CLUTTER Jean Dezert NERA, 29 Av. Division Leclerc 92320 Châtillon, France fax:+33146734167 dezert@onera.fr Ning Li, X. Rong Li University of New rleans New rleans,

More information

Optimal Linear Estimation Fusion Part I: Unified Fusion Rules

Optimal Linear Estimation Fusion Part I: Unified Fusion Rules 2192 IEEE TRANSACTIONS ON INFORMATION THEORY, VOL 49, NO 9, SEPTEMBER 2003 Optimal Linear Estimation Fusion Part I: Unified Fusion Rules X Rong Li, Senior Member, IEEE, Yunmin Zhu, Jie Wang, Chongzhao

More information

Sequential Detection of RGPO in Target Tracking by Decomposition and Fusion Approach

Sequential Detection of RGPO in Target Tracking by Decomposition and Fusion Approach Sequential Detection of RGPO in Target Tracing by Decomposition and Fusion Approach Jing Hou,X.RongLi 2, Vesselin P. Jilov 2, Zhanrong Jing Department of Electronic and Information Northwestern Polytechnical

More information

Measure of Nonlinearity for Stochastic Systems

Measure of Nonlinearity for Stochastic Systems Measure of Nonlinearity for Stochastic Systems X. Rong Li Department of Electrical Engineering, University of New Orleans New Orleans, LA 70148, U.S.A. Email: xli@uno.edu Abstract Knowledge of how nonlinear

More information

Distributed estimation in sensor networks

Distributed estimation in sensor networks in sensor networks A. Benavoli Dpt. di Sistemi e Informatica Università di Firenze, Italy. e-mail: benavoli@dsi.unifi.it Outline 1 An introduction to 2 3 An introduction to An introduction to In recent

More information

The Cardinality Balanced Multi-Target Multi-Bernoulli Filter and its Implementations

The Cardinality Balanced Multi-Target Multi-Bernoulli Filter and its Implementations PREPRINT: IEEE TRANSACTIONS ON SIGNAL PROCESSING, VOL. 57, NO. 2, PP. 49-423, 29 1 The Cardinality Balanced Multi-Target Multi-Bernoulli Filter and its Implementations Ba-Tuong Vo, Ba-Ngu Vo, and Antonio

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

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

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