Added stereo blockmatching algorithm