Finished linearization for the kalman smoothing