drivers/net/ethernet/mellanox/mlx5/core/lib/hv.c

   1 // SPDX-License-Identifier: GPL-2.0 OR Linux-OpenIB
   2 // Copyright (c) 2018 Mellanox Technologies
   3
   4 #include <linux/hyperv.h>
   5 #include "mlx5_core.h"
   6 #include "lib/hv.h"
   7
   8 static int mlx5_hv_config_common(struct mlx5_core_dev *dev, void *buf, int len,
   9                                  int offset, bool read)
  10 {
  11         int rc = -EOPNOTSUPP;
  12         int bytes_returned;
  13         int block_id;
  14
  15         if (offset % HV_CONFIG_BLOCK_SIZE_MAX || len != HV_CONFIG_BLOCK_SIZE_MAX)
  16                 return -EINVAL;
  17
  18         block_id = offset / HV_CONFIG_BLOCK_SIZE_MAX;
  19
  20         rc = read ?
  21              hyperv_read_cfg_blk(dev->pdev, buf,
  22                                  HV_CONFIG_BLOCK_SIZE_MAX, block_id,
  23                                  &bytes_returned) :
  24              hyperv_write_cfg_blk(dev->pdev, buf,
  25                                   HV_CONFIG_BLOCK_SIZE_MAX, block_id);
  26
  27         /* Make sure len bytes were read successfully  */
  28         if (read && !rc && len != bytes_returned)
  29                 rc = -EIO;
  30
  31         if (rc) {
  32                 mlx5_core_err(dev, "Failed to %s hv config, err = %d, len = %d, offset = %d\n",
  33                               read ? "read" : "write", rc, len,
  34                               offset);
  35                 return rc;
  36         }
  37
  38         return 0;
  39 }
  40
  41 int mlx5_hv_read_config(struct mlx5_core_dev *dev, void *buf, int len,
  42                         int offset)
  43 {
  44         return mlx5_hv_config_common(dev, buf, len, offset, true);
  45 }
  46
  47 int mlx5_hv_write_config(struct mlx5_core_dev *dev, void *buf, int len,
  48                          int offset)
  49 {
  50         return mlx5_hv_config_common(dev, buf, len, offset, false);
  51 }
  52
  53 int mlx5_hv_register_invalidate(struct mlx5_core_dev *dev, void *context,
  54                                 void (*block_invalidate)(void *context,
  55                                                          u64 block_mask))
  56 {
  57         return hyperv_reg_block_invalidate(dev->pdev, context,
  58                                            block_invalidate);
  59 }
  60
  61 void mlx5_hv_unregister_invalidate(struct mlx5_core_dev *dev)
  62 {
  63         hyperv_reg_block_invalidate(dev->pdev, NULL, NULL);
  64 }