blockMatrixDiagonal function

Creates block diagonal matrix. It is used internally.