Working example of honorio-samaras algorithm

This example is really rough, and there is debugging code everywhere.
But this state works.
Code cleanup
Optimized Newton-Raphson step.