Line Extraction: bug fixed in adding line constraints to the graph. Temporarily solution in the write function of LaserRobotData, to be fixed.
Merge branch 'master' of https://github.com/grisetti/g2o_frontend