Locally Consistent ToF and Stereo Data Fusion