Fixes for Matrix2

Fixed failing addition
Fixed failing copy
Fixed methods not using template matrix2