Change method for set complement.

- move parts of code to form_schur method
- optimization of Schur complements creating
Update of Schur complement unit test.