First release of RANSAC algorithm, so far not working