Added iterative algorithm for point to linear object registration. Uses output of previous algorithm as initial guess.