Added testing framework

Now, we have a testing framework which allows us to "measure" the
accuracy of the new method. We simply need now to add more "reference"
points to the tests to check its accuracy.