Changed class used to compute disparity map to StereoSGBM. The quality of the map has improved. There were some performance issues (see comment section below).