diagonalizematrix function

It constructs a block-diagonal matrix.