1c6acd629SVladyslav Tarasiuk // SPDX-License-Identifier: GPL-2.0 OR Linux-OpenIB
2c6acd629SVladyslav Tarasiuk /* Copyright (c) 2020, Mellanox Technologies inc.  All rights reserved. */
3c6acd629SVladyslav Tarasiuk 
4c6acd629SVladyslav Tarasiuk #include "en/devlink.h"
55a65d85dSRoi Dayan #include "eswitch.h"
65a65d85dSRoi Dayan 
7ee75f1fcSJiri Pirko static const struct devlink_ops mlx5e_devlink_ops = {
8ee75f1fcSJiri Pirko };
9ee75f1fcSJiri Pirko 
mlx5e_create_devlink(struct device * dev,struct mlx5_core_dev * mdev)10*de411a82SJiri Pirko struct mlx5e_dev *mlx5e_create_devlink(struct device *dev,
11*de411a82SJiri Pirko 				       struct mlx5_core_dev *mdev)
12ee75f1fcSJiri Pirko {
13ee75f1fcSJiri Pirko 	struct mlx5e_dev *mlx5e_dev;
14ee75f1fcSJiri Pirko 	struct devlink *devlink;
15ee75f1fcSJiri Pirko 
16*de411a82SJiri Pirko 	devlink = devlink_alloc_ns(&mlx5e_devlink_ops, sizeof(*mlx5e_dev),
17*de411a82SJiri Pirko 				   devlink_net(priv_to_devlink(mdev)), dev);
18ee75f1fcSJiri Pirko 	if (!devlink)
19ee75f1fcSJiri Pirko 		return ERR_PTR(-ENOMEM);
20ee75f1fcSJiri Pirko 	devlink_register(devlink);
21ee75f1fcSJiri Pirko 	return devlink_priv(devlink);
22ee75f1fcSJiri Pirko }
23ee75f1fcSJiri Pirko 
mlx5e_destroy_devlink(struct mlx5e_dev * mlx5e_dev)24ee75f1fcSJiri Pirko void mlx5e_destroy_devlink(struct mlx5e_dev *mlx5e_dev)
25ee75f1fcSJiri Pirko {
26ee75f1fcSJiri Pirko 	struct devlink *devlink = priv_to_devlink(mlx5e_dev);
27ee75f1fcSJiri Pirko 
28ee75f1fcSJiri Pirko 	devlink_unregister(devlink);
29ee75f1fcSJiri Pirko 	devlink_free(devlink);
30ee75f1fcSJiri Pirko }
31ee75f1fcSJiri Pirko 
325a65d85dSRoi Dayan static void
mlx5e_devlink_get_port_parent_id(struct mlx5_core_dev * dev,struct netdev_phys_item_id * ppid)335a65d85dSRoi Dayan mlx5e_devlink_get_port_parent_id(struct mlx5_core_dev *dev, struct netdev_phys_item_id *ppid)
345a65d85dSRoi Dayan {
355a65d85dSRoi Dayan 	u64 parent_id;
365a65d85dSRoi Dayan 
375a65d85dSRoi Dayan 	parent_id = mlx5_query_nic_system_image_guid(dev);
385a65d85dSRoi Dayan 	ppid->id_len = sizeof(parent_id);
395a65d85dSRoi Dayan 	memcpy(ppid->id, &parent_id, sizeof(parent_id));
405a65d85dSRoi Dayan }
41c6acd629SVladyslav Tarasiuk 
mlx5e_devlink_port_register(struct mlx5e_dev * mlx5e_dev,struct mlx5_core_dev * mdev)42ee75f1fcSJiri Pirko int mlx5e_devlink_port_register(struct mlx5e_dev *mlx5e_dev,
43ccd672bcSJiri Pirko 				struct mlx5_core_dev *mdev)
44c6acd629SVladyslav Tarasiuk {
45ee75f1fcSJiri Pirko 	struct devlink *devlink = priv_to_devlink(mlx5e_dev);
4671ad8d55SDanielle Ratson 	struct devlink_port_attrs attrs = {};
475a65d85dSRoi Dayan 	struct netdev_phys_item_id ppid = {};
485a65d85dSRoi Dayan 	unsigned int dl_port_index;
49c6acd629SVladyslav Tarasiuk 
50ccd672bcSJiri Pirko 	if (mlx5_core_is_pf(mdev)) {
5171ad8d55SDanielle Ratson 		attrs.flavour = DEVLINK_PORT_FLAVOUR_PHYSICAL;
52ccd672bcSJiri Pirko 		attrs.phys.port_number = mlx5_get_dev_index(mdev);
53ccd672bcSJiri Pirko 		if (MLX5_ESWITCH_MANAGER(mdev)) {
54ccd672bcSJiri Pirko 			mlx5e_devlink_get_port_parent_id(mdev, &ppid);
555a65d85dSRoi Dayan 			memcpy(attrs.switch_id.id, ppid.id, ppid.id_len);
565a65d85dSRoi Dayan 			attrs.switch_id.id_len = ppid.id_len;
575a65d85dSRoi Dayan 		}
58ccd672bcSJiri Pirko 		dl_port_index = mlx5_esw_vport_to_devlink_port_index(mdev,
595a65d85dSRoi Dayan 								     MLX5_VPORT_UPLINK);
6071ad8d55SDanielle Ratson 	} else {
6171ad8d55SDanielle Ratson 		attrs.flavour = DEVLINK_PORT_FLAVOUR_VIRTUAL;
62ccd672bcSJiri Pirko 		dl_port_index = mlx5_esw_vport_to_devlink_port_index(mdev, 0);
6371ad8d55SDanielle Ratson 	}
6471ad8d55SDanielle Ratson 
65c30f3faaSJiri Pirko 	devlink_port_attrs_set(&mlx5e_dev->dl_port, &attrs);
66162add8cSParav Pandit 
67c30f3faaSJiri Pirko 	return devlink_port_register(devlink, &mlx5e_dev->dl_port,
68c30f3faaSJiri Pirko 				     dl_port_index);
6931e87b39SVladyslav Tarasiuk }
7031e87b39SVladyslav Tarasiuk 
mlx5e_devlink_port_unregister(struct mlx5e_dev * mlx5e_dev)71c30f3faaSJiri Pirko void mlx5e_devlink_port_unregister(struct mlx5e_dev *mlx5e_dev)
72c6acd629SVladyslav Tarasiuk {
73c30f3faaSJiri Pirko 	devlink_port_unregister(&mlx5e_dev->dl_port);
74c6acd629SVladyslav Tarasiuk }
75