Now use MatrixUtils; added a few comments