Iterated smoother

Misc improvements to the iterated smoother implementation.