1. Add a tolerance.

And replace matrix norms by vectors norms (suggested by @mhsnjvd ).


It would be great if people do run the tests before merging...