Added declaration and initialization of block-matrices.
Fixed formatting