| // SPDX-License-Identifier: GPL-2.0 OR Linux-OpenIB |
| /* Copyright (c) 2020 Mellanox Technologies Ltd */ |
| |
| #include <linux/mlx5/driver.h> |
| #include <linux/mlx5/device.h> |
| #include <linux/mlx5/eswitch.h> |
| #include "mlx5_core.h" |
| #include "dev.h" |
| #include "devlink.h" |
| |
| static int mlx5_core_peer_devlink_set(struct mlx5_sf_dev *sf_dev, struct devlink *devlink) |
| { |
| struct mlx5_sf_peer_devlink_event_ctx event_ctx = { |
| .fn_id = sf_dev->fn_id, |
| .devlink = devlink, |
| }; |
| int ret; |
| |
| ret = mlx5_blocking_notifier_call_chain(sf_dev->parent_mdev, |
| MLX5_DRIVER_EVENT_SF_PEER_DEVLINK, |
| &event_ctx); |
| return ret == NOTIFY_OK ? event_ctx.err : 0; |
| } |
| |
| static int mlx5_sf_dev_probe(struct auxiliary_device *adev, const struct auxiliary_device_id *id) |
| { |
| struct mlx5_sf_dev *sf_dev = container_of(adev, struct mlx5_sf_dev, adev); |
| struct mlx5_core_dev *mdev; |
| struct devlink *devlink; |
| int err; |
| |
| devlink = mlx5_devlink_alloc(&adev->dev); |
| if (!devlink) |
| return -ENOMEM; |
| |
| mdev = devlink_priv(devlink); |
| mdev->device = &adev->dev; |
| mdev->pdev = sf_dev->parent_mdev->pdev; |
| mdev->bar_addr = sf_dev->bar_base_addr; |
| mdev->iseg_base = sf_dev->bar_base_addr; |
| mdev->coredev_type = MLX5_COREDEV_SF; |
| mdev->priv.parent_mdev = sf_dev->parent_mdev; |
| mdev->priv.adev_idx = adev->id; |
| sf_dev->mdev = mdev; |
| |
| /* Only local SFs do light probe */ |
| if (MLX5_ESWITCH_MANAGER(sf_dev->parent_mdev)) |
| mlx5_dev_set_lightweight(mdev); |
| |
| err = mlx5_mdev_init(mdev, MLX5_SF_PROF); |
| if (err) { |
| mlx5_core_warn(mdev, "mlx5_mdev_init on err=%d\n", err); |
| goto mdev_err; |
| } |
| |
| mdev->iseg = ioremap(mdev->iseg_base, sizeof(*mdev->iseg)); |
| if (!mdev->iseg) { |
| mlx5_core_warn(mdev, "remap error\n"); |
| err = -ENOMEM; |
| goto remap_err; |
| } |
| |
| if (MLX5_ESWITCH_MANAGER(sf_dev->parent_mdev)) |
| err = mlx5_init_one_light(mdev); |
| else |
| err = mlx5_init_one(mdev); |
| if (err) { |
| mlx5_core_warn(mdev, "mlx5_init_one err=%d\n", err); |
| goto init_one_err; |
| } |
| |
| err = mlx5_core_peer_devlink_set(sf_dev, devlink); |
| if (err) { |
| mlx5_core_warn(mdev, "mlx5_core_peer_devlink_set err=%d\n", err); |
| goto peer_devlink_set_err; |
| } |
| |
| devlink_register(devlink); |
| return 0; |
| |
| peer_devlink_set_err: |
| if (mlx5_dev_is_lightweight(sf_dev->mdev)) |
| mlx5_uninit_one_light(sf_dev->mdev); |
| else |
| mlx5_uninit_one(sf_dev->mdev); |
| init_one_err: |
| iounmap(mdev->iseg); |
| remap_err: |
| mlx5_mdev_uninit(mdev); |
| mdev_err: |
| mlx5_devlink_free(devlink); |
| return err; |
| } |
| |
| static void mlx5_sf_dev_remove(struct auxiliary_device *adev) |
| { |
| struct mlx5_sf_dev *sf_dev = container_of(adev, struct mlx5_sf_dev, adev); |
| struct mlx5_core_dev *mdev = sf_dev->mdev; |
| struct devlink *devlink; |
| |
| devlink = priv_to_devlink(mdev); |
| set_bit(MLX5_BREAK_FW_WAIT, &mdev->intf_state); |
| mlx5_drain_health_wq(mdev); |
| if (mlx5_dev_is_lightweight(mdev)) |
| mlx5_uninit_one_light(mdev); |
| else |
| mlx5_uninit_one(mdev); |
| iounmap(mdev->iseg); |
| mlx5_mdev_uninit(mdev); |
| mlx5_devlink_free(devlink); |
| } |
| |
| static void mlx5_sf_dev_shutdown(struct auxiliary_device *adev) |
| { |
| struct mlx5_sf_dev *sf_dev = container_of(adev, struct mlx5_sf_dev, adev); |
| struct mlx5_core_dev *mdev = sf_dev->mdev; |
| |
| set_bit(MLX5_BREAK_FW_WAIT, &mdev->intf_state); |
| mlx5_unload_one(mdev, false); |
| } |
| |
| static const struct auxiliary_device_id mlx5_sf_dev_id_table[] = { |
| { .name = MLX5_ADEV_NAME "." MLX5_SF_DEV_ID_NAME, }, |
| { }, |
| }; |
| |
| MODULE_DEVICE_TABLE(auxiliary, mlx5_sf_dev_id_table); |
| |
| static struct auxiliary_driver mlx5_sf_driver = { |
| .name = MLX5_SF_DEV_ID_NAME, |
| .probe = mlx5_sf_dev_probe, |
| .remove = mlx5_sf_dev_remove, |
| .shutdown = mlx5_sf_dev_shutdown, |
| .id_table = mlx5_sf_dev_id_table, |
| }; |
| |
| int mlx5_sf_driver_register(void) |
| { |
| return auxiliary_driver_register(&mlx5_sf_driver); |
| } |
| |
| void mlx5_sf_driver_unregister(void) |
| { |
| auxiliary_driver_unregister(&mlx5_sf_driver); |
| } |