Fix addCorrespondences with std::vector
Fix number of lines drawn and color of the lines