Build a block diagonal matrix from two matrices
stsm_bdiag(A, B)
A
The top left matrix
B
The bottom right matrix
A block diagonal matrix