There were various issues with the construction of sparse submatrices.

By the way, refactor and document the code to make it more readable.