Algorithm 1 Line tracking

Construct a line with first two points. repeat    if the next point is close to the line then      add it to the set of points and fit the line to them.    else      create a new line with the next two points.    end if until no points are remained