Fixed LaserRobotData write for VertexSE2, plus cosmetics stuff in line extraction GUI, plus some usefull math functions usefull for alignment algorithm with line2d