Iterated Sigma-Point Kalman Filtering for Trajectory Reconstruction

Two second-order Kalman filtering methods are added to the New Statistical Trajec-tory Estimation Program (NewSTEP). The two filters are of the class of Sigma-Point Kalman Filters, namely the Unscented Kalman Filter and the Divided Difference Filter. Both filters are implemented with an iterative measurement update step. Results from simulation test case and a flight data test case are provided to show the filter performance. The results indicate that the new second-order filters pro-duce trajectory estimates with reduced uncertainties when compared to the existing first-order filtering method.