Tested version of LaserScan, ScanSegment and LineSegment. Still missing merging at ScanSegment level to join close segments. Not convinced on jumping criteria applieda at LaserScan::ranges2xy()