Added homography code

Not complete yet