Real-Time Stereo Using Foreground Segmentation and Hierarchical Disparity Estimation