bdiag_m function

Block diagonal matrix