// SPDX-License-Identifier: GPL-2.0 OR Linux-OpenIB
/* Copyright (c) 2020 Mellanox Technologies Ltd. */

#include <linux/mlx5/driver.h>
#include "eswitch.h"
#include "devlink.h"
#include "diag/reporter_vnic.h"

static int
mlx5_esw_rep_vnic_reporter_diagnose(struct devlink_health_reporter *reporter,
				    struct devlink_fmsg *fmsg,
				    struct netlink_ext_ack *extack)
{
	struct mlx5_vport *vport = devlink_health_reporter_priv(reporter);

	mlx5_reporter_vnic_diagnose_counters(vport->dev, fmsg, vport->vport,
					     true);

	return 0;
}

static const
struct devlink_health_reporter_ops mlx5_esw_rep_vnic_reporter_ops = {
	.name = "vnic",
	.diagnose = mlx5_esw_rep_vnic_reporter_diagnose,
};

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

static bool mlx5_esw_devlink_port_supported(struct mlx5_eswitch *esw, u16 vport_num)
{
	return (mlx5_core_is_ecpf(esw->dev) &&
		vport_num == MLX5_VPORT_HOST_PF) ||
	       mlx5_eswitch_is_vf_vport(esw, vport_num) ||
	       mlx5_core_is_ec_vf_vport(esw->dev, vport_num) ||
	       mlx5_esw_is_spf_vport(esw, vport_num);
}

static void mlx5_esw_offloads_pf_vf_devlink_port_attrs_set(struct mlx5_eswitch *esw,
							   u16 vport_num,
							   struct devlink_port *dl_port)
{
	struct mlx5_core_dev *dev = esw->dev;
	struct netdev_phys_item_id ppid = {};
	struct mlx5_vport *vport;
	u32 controller_num = 0;
	bool external;
	u16 pfnum;

	mlx5_esw_get_port_parent_id(dev, &ppid);
	pfnum = PCI_FUNC(dev->pdev->devfn);
	external = mlx5_core_is_ecpf_esw_manager(dev);
	if (external)
		controller_num = mlx5_esw_get_hpf_host_number(dev) + 1;

	if (vport_num == MLX5_VPORT_HOST_PF) {
		if (external)
			pfnum = mlx5_esw_get_hpf_pf_num(dev);
		memcpy(dl_port->attrs.switch_id.id, ppid.id, ppid.id_len);
		dl_port->attrs.switch_id.id_len = ppid.id_len;
		devlink_port_attrs_pci_pf_set(dl_port, controller_num, pfnum, external);
	} else if (mlx5_eswitch_is_vf_vport(esw, vport_num)) {
		u16 func_id = vport_num - 1;

		vport = mlx5_eswitch_get_vport(esw, vport_num);
		memcpy(dl_port->attrs.switch_id.id, ppid.id, ppid.id_len);
		dl_port->attrs.switch_id.id_len = ppid.id_len;
		if (vport->adjacent) {
			func_id = vport->adj_info.function_id;
			pfnum = vport->adj_info.parent_pci_devfn;
		} else if (external) {
			pfnum = mlx5_esw_get_hpf_pf_num(dev);
		}

		devlink_port_attrs_pci_vf_set(dl_port, controller_num, pfnum,
					      func_id, external);
	}  else if (mlx5_core_is_ec_vf_vport(esw->dev, vport_num)) {
		u16 base_vport = mlx5_core_ec_vf_vport_base(dev);

		memcpy(dl_port->attrs.switch_id.id, ppid.id, ppid.id_len);
		dl_port->attrs.switch_id.id_len = ppid.id_len;
		devlink_port_attrs_pci_vf_set(dl_port, 0, pfnum,
					      vport_num - base_vport, false);
	} else if (mlx5_esw_is_spf_vport(esw, vport_num)) {
		int spf_idx = mlx5_esw_spf_vport_to_idx(esw, vport_num);

		controller_num = esw->esw_funcs.spfs[spf_idx].host_number + 1;
		pfnum = esw->esw_funcs.spfs[spf_idx].pf_num;

		memcpy(dl_port->attrs.switch_id.id, ppid.id, ppid.id_len);
		dl_port->attrs.switch_id.id_len = ppid.id_len;
		devlink_port_attrs_pci_pf_set(dl_port, controller_num, pfnum,
					      false);
	}
}

int mlx5_esw_offloads_pf_vf_devlink_port_init(struct mlx5_eswitch *esw,
					      struct mlx5_vport *vport)
{
	struct mlx5_devlink_port *dl_port;
	u16 vport_num = vport->vport;

	if (!mlx5_esw_devlink_port_supported(esw, vport_num))
		return 0;

	dl_port = kzalloc_obj(*dl_port);
	if (!dl_port)
		return -ENOMEM;

	mlx5_esw_offloads_pf_vf_devlink_port_attrs_set(esw, vport_num,
						       &dl_port->dl_port);

	vport->dl_port = dl_port;
	mlx5_devlink_port_init(dl_port, vport);
	return 0;
}

void mlx5_esw_offloads_pf_vf_devlink_port_cleanup(struct mlx5_eswitch *esw,
						  struct mlx5_vport *vport)
{
	if (!vport->dl_port)
		return;

	kfree(vport->dl_port);
	vport->dl_port = NULL;
}

static const struct devlink_port_ops mlx5_esw_pf_vf_dl_port_ops = {
	.port_fn_hw_addr_get = mlx5_devlink_port_fn_hw_addr_get,
	.port_fn_hw_addr_set = mlx5_devlink_port_fn_hw_addr_set,
	.port_fn_roce_get = mlx5_devlink_port_fn_roce_get,
	.port_fn_roce_set = mlx5_devlink_port_fn_roce_set,
	.port_fn_migratable_get = mlx5_devlink_port_fn_migratable_get,
	.port_fn_migratable_set = mlx5_devlink_port_fn_migratable_set,
	.port_fn_state_get = mlx5_devlink_pf_port_fn_state_get,
	.port_fn_state_set = mlx5_devlink_pf_port_fn_state_set,
#ifdef CONFIG_XFRM_OFFLOAD
	.port_fn_ipsec_crypto_get = mlx5_devlink_port_fn_ipsec_crypto_get,
	.port_fn_ipsec_crypto_set = mlx5_devlink_port_fn_ipsec_crypto_set,
	.port_fn_ipsec_packet_get = mlx5_devlink_port_fn_ipsec_packet_get,
	.port_fn_ipsec_packet_set = mlx5_devlink_port_fn_ipsec_packet_set,
#endif /* CONFIG_XFRM_OFFLOAD */
	.port_fn_max_io_eqs_get = mlx5_devlink_port_fn_max_io_eqs_get,
	.port_fn_max_io_eqs_set = mlx5_devlink_port_fn_max_io_eqs_set,
};

static void mlx5_esw_offloads_sf_devlink_port_attrs_set(struct mlx5_eswitch *esw,
							struct devlink_port *dl_port,
							u32 controller, u32 sfnum)
{
	struct mlx5_core_dev *dev = esw->dev;
	struct netdev_phys_item_id ppid = {};
	u32 hpf_ctrl;
	u16 pfnum;

	pfnum = mlx5_esw_sf_controller_to_pfnum(dev, controller);
	hpf_ctrl = mlx5_esw_get_hpf_host_number(dev) + 1;
	mlx5_esw_get_port_parent_id(dev, &ppid);
	memcpy(dl_port->attrs.switch_id.id, &ppid.id[0], ppid.id_len);
	dl_port->attrs.switch_id.id_len = ppid.id_len;
	devlink_port_attrs_pci_sf_set(dl_port, controller, pfnum, sfnum,
				      controller == hpf_ctrl);
}

int mlx5_esw_offloads_sf_devlink_port_init(struct mlx5_eswitch *esw, struct mlx5_vport *vport,
					   struct mlx5_devlink_port *dl_port,
					   u32 controller, u32 sfnum)
{
	mlx5_esw_offloads_sf_devlink_port_attrs_set(esw, &dl_port->dl_port, controller, sfnum);

	vport->dl_port = dl_port;
	mlx5_devlink_port_init(dl_port, vport);
	return 0;
}

void mlx5_esw_offloads_sf_devlink_port_cleanup(struct mlx5_eswitch *esw, struct mlx5_vport *vport)
{
	vport->dl_port = NULL;
}

static const struct devlink_port_ops mlx5_esw_dl_sf_port_ops = {
#ifdef CONFIG_MLX5_SF_MANAGER
	.port_del = mlx5_devlink_sf_port_del,
#endif
	.port_fn_hw_addr_get = mlx5_devlink_port_fn_hw_addr_get,
	.port_fn_hw_addr_set = mlx5_devlink_port_fn_hw_addr_set,
	.port_fn_roce_get = mlx5_devlink_port_fn_roce_get,
	.port_fn_roce_set = mlx5_devlink_port_fn_roce_set,
#ifdef CONFIG_MLX5_SF_MANAGER
	.port_fn_state_get = mlx5_devlink_sf_port_fn_state_get,
	.port_fn_state_set = mlx5_devlink_sf_port_fn_state_set,
#endif
	.port_fn_max_io_eqs_get = mlx5_devlink_port_fn_max_io_eqs_get,
	.port_fn_max_io_eqs_set = mlx5_devlink_port_fn_max_io_eqs_set,
};

static int mlx5_esw_devlink_port_res_register(struct mlx5_eswitch *esw,
					      struct devlink_port *dl_port,
					      u16 vport_num)
{
	struct devlink_resource_size_params size_params;
	struct mlx5_core_dev *dev = esw->dev;
	u16 max_sfs, sf_base_id;
	int err;

	if (vport_num != MLX5_VPORT_HOST_PF &&
	    !mlx5_esw_is_spf_vport(esw, vport_num))
		return 0;

	if (vport_num == MLX5_VPORT_HOST_PF) {
		err = mlx5_esw_sf_max_hpf_functions(dev, &max_sfs,
						    &sf_base_id);
	} else {
		int spf_idx = mlx5_esw_spf_vport_to_idx(esw, vport_num);

		err = mlx5_esw_sf_max_spf_functions(dev, spf_idx, &max_sfs,
						    &sf_base_id);
	}

	if (err)
		return err;

	devlink_resource_size_params_init(&size_params, max_sfs, max_sfs, 1,
					  DEVLINK_RESOURCE_UNIT_ENTRY);

	return devl_port_resource_register(dl_port, "max_SFs", max_sfs,
					   MLX5_DL_PORT_RES_MAX_SFS,
					   DEVLINK_RESOURCE_ID_PARENT_TOP,
					   &size_params);
}

static void mlx5_esw_devlink_port_res_unregister(struct devlink_port *dl_port)
{
	devl_port_resources_unregister(dl_port);
}

int mlx5_esw_offloads_devlink_port_register(struct mlx5_eswitch *esw, struct mlx5_vport *vport)
{
	struct devlink_health_reporter *reporter;
	struct mlx5_core_dev *dev = esw->dev;
	const struct devlink_port_ops *ops;
	struct mlx5_devlink_port *dl_port;
	u16 vport_num = vport->vport;
	unsigned int dl_port_index;
	struct devlink *devlink;
	int err;

	dl_port = vport->dl_port;
	if (!dl_port)
		return 0;

	if (mlx5_esw_is_sf_vport(esw, vport_num))
		ops = &mlx5_esw_dl_sf_port_ops;
	else if (mlx5_eswitch_is_pf_vf_vport(esw, vport_num))
		ops = &mlx5_esw_pf_vf_dl_port_ops;
	else
		ops = NULL;

	devlink = priv_to_devlink(dev);
	dl_port_index = mlx5_esw_vport_to_devlink_port_index(dev, vport_num);
	err = devl_port_register_with_ops(devlink, &dl_port->dl_port, dl_port_index, ops);
	if (err)
		return err;

	err = devl_rate_leaf_create(&dl_port->dl_port, vport, NULL);
	if (err)
		goto rate_err;

	err = mlx5_esw_devlink_port_res_register(esw, &dl_port->dl_port,
						 vport_num);
	if (err)
		mlx5_core_dbg(dev, "Failed to register port resources: %d\n",
			      err);

	reporter = devl_port_health_reporter_create(
		&dl_port->dl_port, &mlx5_esw_rep_vnic_reporter_ops,
		vport);
	if (IS_ERR(reporter))
		mlx5_core_err(dev,
			      "Failed to create vnic health reporter for vport %d: %pe\n",
			      vport_num, reporter);
	else
		dl_port->vnic_reporter = reporter;

	return 0;

rate_err:
	devl_port_unregister(&dl_port->dl_port);
	return err;
}

void mlx5_esw_offloads_devlink_port_unregister(struct mlx5_vport *vport)
{
	struct mlx5_devlink_port *dl_port;

	if (!vport->dl_port)
		return;
	dl_port = vport->dl_port;

	if (dl_port->vnic_reporter) {
		devl_health_reporter_destroy(dl_port->vnic_reporter);
		dl_port->vnic_reporter = NULL;
	}

	mlx5_esw_devlink_port_res_unregister(&dl_port->dl_port);

	devl_rate_leaf_destroy(&dl_port->dl_port);

	devl_port_unregister(&dl_port->dl_port);
}

struct devlink_port *mlx5_esw_offloads_devlink_port(struct mlx5_eswitch *esw, u16 vport_num)
{
	struct mlx5_vport *vport;

	vport = mlx5_eswitch_get_vport(esw, vport_num);
	if (IS_ERR(vport))
		return ERR_CAST(vport);
	if (!vport->dl_port)
		return ERR_PTR(-ENODEV);

	return &vport->dl_port->dl_port;
}