[Enhancement] Adding block-diagonal-matrix construction function #93

Here's my noobish attempt at writing a function for construction of a block diagonal matrix. Is this what you had in mind?