LineFinderIterative: Remove outliers front&back points
Sometimes, the front/back points of the segment is not actually a point that fits in the first/last line. It happens since the iterative method checks the error of all intermediate points for the line between two points (one of them is the front/back) A solution may be checking the fitting error of front/back segment points (after fitting the corresponding line with all points) and discarding it if it is over a threshold. Segment previous/next point should be updated with the discarded point if it is the case.