The Iterated Sigma Point Kalman Filter with Applications to Long Range Stereo
A new method for the nonlinear transformation of means and covariances in filters and estimators