Changed matrix add methods to have zeros for a nice-looking print of the matrix as well as deleted bad algorithm