Hough Line extraction debugged and checked with TNO rosbag. It remains to modify entry type of laser points