Bdiag function

Create block diagonal matrix