| Summary: | This paper presents the results of applying the new mechanization of the Kalman filter (KF) algorithm using singular value decomposition (SVD). The proposed algorithm is useful in applications where the influence of round-off errors reduces the accuracy of the numerical solution of the associated Riccati equation. When the Riccati equation does not remain symmetric and positive definite, the fidelity of the solution can degrade to the point where it corrupts the Kalman gain, and it can corrupt the estimate. In this research, we design an adaptive KF implementation based on SVD, provide its derivation, and discuss the stability issues numerically. The filter is derived by substituting the SVD of the covariance matrix into the conventional discrete KF equations after its initial propagation, and an adaptive estimation of the covariance measurement matrix <inline-formula><math display="inline"><semantics><mrow><msub><mi>R</mi><mi>k</mi></msub></mrow></semantics></math></inline-formula> is introduced. The results show that the algorithm is equivalent to current methods in terms of robustness, and it outperforms the estimation accuracy of the conventional Kalman filter, square root, and unit triangular matrix diagonal (UD) factorization methods under ill-conditioned and dynamic applications, and is applicable to most nonlinear systems. Four sample problems from different areas are presented for comparative study from an ill-conditioned sensitivity matrix, navigation with a dual-frequency Global Positioning System (GPS) receiver, host vehicle dynamic models, and distance measuring equipment (DME) using simultaneous slant range measurements, performed with a conventional KF and SVD-based (K-SVD) filter.
|
|---|