Starting writing code for RANSAC matrix estimation