Wrote a basic matrix add routine which works if one summand is structurally a sub-matrix of the other