Added test of goodFeaturesToTrack
Started working on the stereo vision pipeline