Stochastic Integration Based Estimator: Robust Design and Stone Soup Implementation

Jindrich Dunik,Jakub Matousek,Ondrej Straka,Erik Blasch,John Hiles,Ruixin Niu
2024-12-10
Abstract:This paper deals with state estimation of nonlinear stochastic dynamic models. In particular, the stochastic integration rule, which provides asymptotically unbiased estimates of the moments of nonlinearly transformed Gaussian random variables, is reviewed together with the recently introduced stochastic integration filter (SIF). Using SIF, the respective multi-step prediction and smoothing algorithms are developed in full and efficient square-root form. The stochastic-integration-rule-based algorithms are implemented in Python (within the Stone Soup framework) and in MATLAB and are numerically evaluated and compared with the well-known unscented and extended Kalman filters using the Stone Soup defined tracking scenario.
Signal Processing
What problem does this paper attempt to address?
### Problems the paper attempts to solve This paper aims to solve the state estimation problem of nonlinear stochastic dynamic models. Specifically, the author focuses on how to provide asymptotically unbiased moment estimates when dealing with Gaussian random variables with nonlinear transformations. To this end, the paper reviews the method based on the Stochastic Integration Rule (SIR) and introduces the recently proposed Stochastic Integration Filter (SIF). The main objectives of the paper are: 1. **Design multi - step prediction and smoothing algorithms**: Complete the design of multi - step prediction and smoothing algorithms in the SIF family. 2. **Develop efficient and robust estimators**: Design efficient estimators in the square - root form to improve numerical stability and computational efficiency. 3. **Implement and evaluate new algorithms**: Implement the latest SIF and its related prediction and smoothing algorithms in Python (using the Stone Soup framework) and MATLAB, and conduct numerical evaluation and comparison through the tracking scenarios defined by Stone Soup. ### Key technical background - **State estimation problem**: State estimation of discrete - time stochastic dynamic systems extracts system state information from noisy or incomplete measurements and has important applications in fields such as navigation, speech and image processing, fault detection, optimal control, and tracking. - **Bayesian method**: The general state estimation solution is given by Functional Recursive Relations (FRRs) for calculating the conditional probability density function (PDF), but these relations usually have analytical solutions only for linear models. - **Gaussian estimator (GE)**: For nonlinear models, common approximation methods include the Extended Kalman Filter (EKF), the Unscented Kalman Filter (UKF), etc. - **Stochastic integration filter (SIF)**: Compared with other Gaussian filters, SIF provides asymptotically exact integral evaluation, thus improving the estimation performance. ### Main contributions 1. **Multi - step prediction and smoothing algorithms**: Proposed multi - step prediction and smoothing algorithms based on SIF, filling the gap in this area. 2. **Efficient square - root form**: Developed an efficient square - root form of SIF, improving numerical stability and computational efficiency. 3. **Public implementation**: Implemented SIF and its related algorithms in the Stone Soup framework of Python and MATLAB, and conducted numerical evaluation, proving its superior performance. ### Numerical experiment results By conducting experiments on a specific tracking scenario, the paper shows the superior performance of SIF compared with EKF and UKF. Specifically: - **Root Mean Square Error (RMSE)**: The RMSE performance of SIF on all state variables is very close to that of EKF and UKF. - **Average Normalized Estimation Error Squared (ANEES)**: The ANEES of SIF is significantly better than that of EKF and UKF, with an improvement of about 40% respectively. In summary, this paper significantly improves the state estimation performance of nonlinear stochastic dynamic models by proposing new multi - step prediction and smoothing algorithms and an efficient square - root form of SIF, and verifies its superiority through experiments.