Started merging stereo camera code