High accuracy TOF and stereo sensor fusion at interactive rates