Stereo Matching with Color-Weighted Correlation, Hierarchical Belief Propagation and Occlusion Handling