Added depth calculation using stereo camera code