Stage 1 RANSAC

Stage 1 handles RANSAC now. Used for demo.