stereo_corr: Add disparity spread when computing disparity from DEM