InterestPointMatching: Print stats first, check matrix later
stereo_corr: Consolidate code