Added ability to publish rviz markers of the lines.