create_block_diagonal function

Create Block Diagonal Matrix