bdiag_m2 function

Bdiag m2