Add stereo block matching code