Rauch-Tung Striebel Smoother (RTS Smoother)

Introduced from Kalman Filter book.