Smoothing calculations verified to give same result as Lindsten&Schon article.
Changed so smoothing estimates used in parameter estimations komers from the
RTS-smoother from KalmanSmoother.