[Important, MF] Update Endpoints Of Lines

Idea from dema, works pretty well (even a little slow at the moment).
I will deal with the speed later. But it works, very well.

Update the endpoints of the lines according to the 3D locations of the
point cloud. Major modifications in LevenburgMaquart.cpp