Implemented normalisation, still have to test and implement ransac