drivers/net/ethernet/mellanox/mlx5/core/sf/dev/driver.c

   1 // SPDX-License-Identifier: GPL-2.0 OR Linux-OpenIB
   2 /* Copyright (c) 2020 Mellanox Technologies Ltd */
   3
   4 #include <linux/mlx5/driver.h>
   5 #include <linux/mlx5/device.h>
   6 #include <linux/mlx5/eswitch.h>
   7 #include "mlx5_core.h"
   8 #include "dev.h"
   9 #include "devlink.h"
  10
  11 static int mlx5_core_peer_devlink_set(struct mlx5_sf_dev *sf_dev, struct devlink *devlink)
  12 {
  13         struct mlx5_sf_peer_devlink_event_ctx event_ctx = {
  14                 .fn_id = sf_dev->fn_id,
  15                 .devlink = devlink,
  16         };
  17         int ret;
  18
  19         ret = mlx5_blocking_notifier_call_chain(sf_dev->parent_mdev,
  20                                                 MLX5_DRIVER_EVENT_SF_PEER_DEVLINK,
  21                                                 &event_ctx);
  22         return ret == NOTIFY_OK ? event_ctx.err : 0;
  23 }
  24
  25 static int mlx5_sf_dev_probe(struct auxiliary_device *adev, const struct auxiliary_device_id *id)
  26 {
  27         struct mlx5_sf_dev *sf_dev = container_of(adev, struct mlx5_sf_dev, adev);
  28         struct mlx5_core_dev *mdev;
  29         struct devlink *devlink;
  30         int err;
  31
  32         devlink = mlx5_devlink_alloc(&adev->dev);
  33         if (!devlink)
  34                 return -ENOMEM;
  35
  36         mdev = devlink_priv(devlink);
  37         mdev->device = &adev->dev;
  38         mdev->pdev = sf_dev->parent_mdev->pdev;
  39         mdev->bar_addr = sf_dev->bar_base_addr;
  40         mdev->iseg_base = sf_dev->bar_base_addr;
  41         mdev->coredev_type = MLX5_COREDEV_SF;
  42         mdev->priv.parent_mdev = sf_dev->parent_mdev;
  43         mdev->priv.adev_idx = adev->id;
  44         sf_dev->mdev = mdev;
  45
  46         /* Only local SFs do light probe */
  47         if (MLX5_ESWITCH_MANAGER(sf_dev->parent_mdev))
  48                 mlx5_dev_set_lightweight(mdev);
  49
  50         err = mlx5_mdev_init(mdev, MLX5_SF_PROF);
  51         if (err) {
  52                 mlx5_core_warn(mdev, "mlx5_mdev_init on err=%d\n", err);
  53                 goto mdev_err;
  54         }
  55
  56         mdev->iseg = ioremap(mdev->iseg_base, sizeof(*mdev->iseg));
  57         if (!mdev->iseg) {
  58                 mlx5_core_warn(mdev, "remap error\n");
  59                 err = -ENOMEM;
  60                 goto remap_err;
  61         }
  62
  63         if (MLX5_ESWITCH_MANAGER(sf_dev->parent_mdev))
  64                 err = mlx5_init_one_light(mdev);
  65         else
  66                 err = mlx5_init_one(mdev);
  67         if (err) {
  68                 mlx5_core_warn(mdev, "mlx5_init_one err=%d\n", err);
  69                 goto init_one_err;
  70         }
  71
  72         err = mlx5_core_peer_devlink_set(sf_dev, devlink);
  73         if (err) {
  74                 mlx5_core_warn(mdev, "mlx5_core_peer_devlink_set err=%d\n", err);
  75                 goto peer_devlink_set_err;
  76         }
  77
  78         return 0;
  79
  80 peer_devlink_set_err:
  81         if (mlx5_dev_is_lightweight(sf_dev->mdev))
  82                 mlx5_uninit_one_light(sf_dev->mdev);
  83         else
  84                 mlx5_uninit_one(sf_dev->mdev);
  85 init_one_err:
  86         iounmap(mdev->iseg);
  87 remap_err:
  88         mlx5_mdev_uninit(mdev);
  89 mdev_err:
  90         mlx5_devlink_free(devlink);
  91         return err;
  92 }
  93
  94 static void mlx5_sf_dev_remove(struct auxiliary_device *adev)
  95 {
  96         struct mlx5_sf_dev *sf_dev = container_of(adev, struct mlx5_sf_dev, adev);
  97         struct mlx5_core_dev *mdev = sf_dev->mdev;
  98         struct devlink *devlink;
  99
 100         devlink = priv_to_devlink(mdev);
 101         set_bit(MLX5_BREAK_FW_WAIT, &mdev->intf_state);
 102         mlx5_drain_health_wq(mdev);
 103         if (mlx5_dev_is_lightweight(mdev))
 104                 mlx5_uninit_one_light(mdev);
 105         else
 106                 mlx5_uninit_one(mdev);
 107         iounmap(mdev->iseg);
 108         mlx5_mdev_uninit(mdev);
 109         mlx5_devlink_free(devlink);
 110 }
 111
 112 static void mlx5_sf_dev_shutdown(struct auxiliary_device *adev)
 113 {
 114         struct mlx5_sf_dev *sf_dev = container_of(adev, struct mlx5_sf_dev, adev);
 115         struct mlx5_core_dev *mdev = sf_dev->mdev;
 116
 117         set_bit(MLX5_BREAK_FW_WAIT, &mdev->intf_state);
 118         mlx5_unload_one(mdev, false);
 119 }
 120
 121 static const struct auxiliary_device_id mlx5_sf_dev_id_table[] = {
 122         { .name = MLX5_ADEV_NAME "." MLX5_SF_DEV_ID_NAME, },
 123         { },
 124 };
 125
 126 MODULE_DEVICE_TABLE(auxiliary, mlx5_sf_dev_id_table);
 127
 128 static struct auxiliary_driver mlx5_sf_driver = {
 129         .name = MLX5_SF_DEV_ID_NAME,
 130         .probe = mlx5_sf_dev_probe,
 131         .remove = mlx5_sf_dev_remove,
 132         .shutdown = mlx5_sf_dev_shutdown,
 133         .id_table = mlx5_sf_dev_id_table,
 134 };
 135
 136 int mlx5_sf_driver_register(void)
 137 {
 138         return auxiliary_driver_register(&mlx5_sf_driver);
 139 }
 140
 141 void mlx5_sf_driver_unregister(void)
 142 {
 143         auxiliary_driver_unregister(&mlx5_sf_driver);
 144 }