IOD initial Least squares batch filter sequential processing smoother kalman optimal