Various minor changes

Adds tracing of the end point's position, starts adding newtons method
in.