Fix number of lines drawn and color of the lines
Use sensor pose information when drawing correspondences