[RANSAC] Added functions
function DistToCurve
function fillMatrixHT
--> unitary test OK