fixed homography code, should be working [returned homographies different from solution]