mrgsolve transport - don't write off diagonals for diagonal matrices

[kylebaron]

Currently, we take the upper triangle and always code it as a block matrix. We can check off-diagonals and skip those (and the @block tag) if appropriate.