Stereo matching algo for real-time application