Depth image to point cloud opencv