Improved numerical stability

Added two lines to force symmetric at the end of _update_submatrix.

Some cleanup.