New method for translation RANSAC (using linear solution) [with TODOs]

TODO: Check the degeneracy function and the threshold (to avoid too many trials)
Added RANSAC parameters for translation in CTrihedronOptimization
New Rotation optimization function in which only diagonal of weights matrix are used