Iterated smoother

- Added asserts for matrix_size() before invoking the analysis linear algebra
- The rml code will recalculate the error for each iteration.