// SPDX-License-Identifier: GPL-2.0 OR Linux-OpenIB
/* Copyright (c) 2020, Mellanox Technologies inc.  All rights reserved. */

#include "en/devlink.h"
#include "eswitch.h"

static const struct devlink_ops mlx5e_devlink_ops = {
};

struct mlx5e_dev *mlx5e_create_devlink(struct device *dev,
                                       struct mlx5_core_dev *mdev)
{
        struct mlx5e_dev *mlx5e_dev;
        struct devlink *devlink;
        int err;

        devlink = devlink_alloc_ns(&mlx5e_devlink_ops, sizeof(*mlx5e_dev),
                                   devlink_net(priv_to_devlink(mdev)), dev);
        if (!devlink)
                return ERR_PTR(-ENOMEM);

        err = devl_nested_devlink_set(priv_to_devlink(mdev), devlink);
        if (err) {
                devlink_free(devlink);
                return ERR_PTR(err);
        }

        devlink_register(devlink);
        return devlink_priv(devlink);
}

void mlx5e_destroy_devlink(struct mlx5e_dev *mlx5e_dev)
{
        struct devlink *devlink = priv_to_devlink(mlx5e_dev);

        devlink_unregister(devlink);
        devlink_free(devlink);
}

static void
mlx5e_devlink_get_port_parent_id(struct mlx5_core_dev *dev, struct netdev_phys_item_id *ppid)
{
        BUILD_BUG_ON(MLX5_SW_IMAGE_GUID_MAX_BYTES > MAX_PHYS_ITEM_ID_LEN);
        mlx5_query_nic_sw_system_image_guid(dev, ppid->id, &ppid->id_len);
}

int mlx5e_devlink_port_register(struct mlx5e_dev *mlx5e_dev,
                                struct mlx5_core_dev *mdev)
{
        struct devlink *devlink = priv_to_devlink(mlx5e_dev);
        struct devlink_port_attrs attrs = {};
        struct netdev_phys_item_id ppid = {};
        unsigned int dl_port_index;

        if (mlx5_core_is_pf(mdev)) {
                attrs.flavour = DEVLINK_PORT_FLAVOUR_PHYSICAL;
                attrs.phys.port_number = mlx5_get_dev_index(mdev);
                if (MLX5_ESWITCH_MANAGER(mdev)) {
                        mlx5e_devlink_get_port_parent_id(mdev, &ppid);
                        memcpy(attrs.switch_id.id, ppid.id, ppid.id_len);
                        attrs.switch_id.id_len = ppid.id_len;
                }
                dl_port_index = mlx5_esw_vport_to_devlink_port_index(mdev,
                                                                     MLX5_VPORT_UPLINK);
        } else {
                attrs.flavour = DEVLINK_PORT_FLAVOUR_VIRTUAL;
                dl_port_index = mlx5_esw_vport_to_devlink_port_index(mdev, 0);
        }

        devlink_port_attrs_set(&mlx5e_dev->dl_port, &attrs);

        return devlink_port_register(devlink, &mlx5e_dev->dl_port,
                                     dl_port_index);
}

void mlx5e_devlink_port_unregister(struct mlx5e_dev *mlx5e_dev)
{
        devlink_port_unregister(&mlx5e_dev->dl_port);
}