Sensor fusion for stereo cameras and ToF