Tue, May 07, 2024 at 01:45:15PM CEST, michal.swiatkow...@linux.intel.com wrote:
>From: Piotr Raczynski <piotr.raczyn...@intel.com>
>
>Use previously implemented SF aux driver. It is probe during SF
>activation and remove after deactivation.
>
>Signed-off-by: Piotr Raczynski <piotr.raczyn...@intel.com>
>Signed-off-by: Michal Swiatkowski <michal.swiatkow...@linux.intel.com>
>---
> .../ethernet/intel/ice/devlink/devlink_port.c | 108 ++++++++++++++++++
> .../ethernet/intel/ice/devlink/devlink_port.h | 6 +
> drivers/net/ethernet/intel/ice/ice_sf_eth.c | 107 +++++++++++++++++
> drivers/net/ethernet/intel/ice/ice_sf_eth.h | 3 +
> 4 files changed, 224 insertions(+)
>
>diff --git a/drivers/net/ethernet/intel/ice/devlink/devlink_port.c
>b/drivers/net/ethernet/intel/ice/devlink/devlink_port.c
>index e8929e91aff2..43ed05e5c883 100644
>--- a/drivers/net/ethernet/intel/ice/devlink/devlink_port.c
>+++ b/drivers/net/ethernet/intel/ice/devlink/devlink_port.c
>@@ -482,6 +482,42 @@ void ice_devlink_destroy_sf_dev_port(struct ice_sf_dev
>*sf_dev)
> devl_port_unregister(&sf_dev->priv->devlink_port);
> }
>
>+/**
>+ * ice_activate_dynamic_port - Activate a dynamic port
>+ * @dyn_port: dynamic port instance to activate
>+ * @extack: extack for reporting error messages
>+ *
>+ * Activate the dynamic port based on its flavour.
>+ *
>+ * Return: zero on success or an error code on failure.
>+ */
>+static int
>+ice_activate_dynamic_port(struct ice_dynamic_port *dyn_port,
>+ struct netlink_ext_ack *extack)
>+{
>+ int err;
>+
>+ err = ice_sf_eth_activate(dyn_port, extack);
>+ if (err)
>+ return err;
>+
>+ dyn_port->active = true;
>+
>+ return 0;
>+}
>+
>+/**
>+ * ice_deactivate_dynamic_port - Deactivate a dynamic port
>+ * @dyn_port: dynamic port instance to deactivate
>+ *
>+ * Undo activation of a dynamic port.
>+ */
>+static void ice_deactivate_dynamic_port(struct ice_dynamic_port *dyn_port)
>+{
>+ ice_sf_eth_deactivate(dyn_port);
>+ dyn_port->active = false;
>+}
>+
> /**
> * ice_dealloc_dynamic_port - Deallocate and remove a dynamic port
> * @dyn_port: dynamic port instance to deallocate
>@@ -494,6 +530,9 @@ static void ice_dealloc_dynamic_port(struct
>ice_dynamic_port *dyn_port)
> struct devlink_port *devlink_port = &dyn_port->devlink_port;
> struct ice_pf *pf = dyn_port->pf;
>
>+ if (dyn_port->active)
>+ ice_deactivate_dynamic_port(dyn_port);
>+
> xa_erase(&pf->sf_nums, devlink_port->attrs.pci_sf.sf);
> ice_eswitch_detach_sf(pf, dyn_port);
> ice_vsi_free(dyn_port->vsi);
>@@ -638,10 +677,79 @@ ice_devlink_port_fn_hw_addr_get(struct devlink_port
>*port, u8 *hw_addr,
> return 0;
> }
>
>+/**
>+ * ice_devlink_port_fn_state_set - devlink handler for port state set
>+ * @port: pointer to devlink port
>+ * @state: state to set
>+ * @extack: extack for reporting error messages
>+ *
>+ * Activates or deactivates the port.
>+ *
>+ * Return: zero on success or an error code on failure.
>+ */
>+static int
>+ice_devlink_port_fn_state_set(struct devlink_port *port,
>+ enum devlink_port_fn_state state,
>+ struct netlink_ext_ack *extack)
>+{
>+ struct ice_dynamic_port *dyn_port;
>+
>+ dyn_port = ice_devlink_port_to_dyn(port);
>+
>+ switch (state) {
>+ case DEVLINK_PORT_FN_STATE_ACTIVE:
>+ if (!dyn_port->active)
>+ return ice_activate_dynamic_port(dyn_port, extack);
>+ break;
>+ case DEVLINK_PORT_FN_STATE_INACTIVE:
>+ if (dyn_port->active)
>+ ice_deactivate_dynamic_port(dyn_port);
>+ break;
>+ }
>+
>+ return 0;
>+}
>+
>+/**
>+ * ice_devlink_port_fn_state_get - devlink handler for port state get
>+ * @port: pointer to devlink port
>+ * @state: admin configured state of the port
>+ * @opstate: current port operational state
>+ * @extack: extack for reporting error messages
>+ *
>+ * Gets port state.
>+ *
>+ * Return: zero on success or an error code on failure.
>+ */
>+static int
>+ice_devlink_port_fn_state_get(struct devlink_port *port,
>+ enum devlink_port_fn_state *state,
>+ enum devlink_port_fn_opstate *opstate,
>+ struct netlink_ext_ack *extack)
>+{
>+ struct ice_dynamic_port *dyn_port;
>+
>+ dyn_port = ice_devlink_port_to_dyn(port);
>+
>+ if (dyn_port->active)
>+ *state = DEVLINK_PORT_FN_STATE_ACTIVE;
>+ else
>+ *state = DEVLINK_PORT_FN_STATE_INACTIVE;
>+
>+ if (dyn_port->attached)
>+ *opstate = DEVLINK_PORT_FN_OPSTATE_ATTACHED;
>+ else
>+ *opstate = DEVLINK_PORT_FN_OPSTATE_DETACHED;
>+
>+ return 0;
>+}
>+
> static const struct devlink_port_ops ice_devlink_port_sf_ops = {
> .port_del = ice_devlink_port_del,
> .port_fn_hw_addr_get = ice_devlink_port_fn_hw_addr_get,
> .port_fn_hw_addr_set = ice_devlink_port_fn_hw_addr_set,
>+ .port_fn_state_get = ice_devlink_port_fn_state_get,
>+ .port_fn_state_set = ice_devlink_port_fn_state_set,
> };
>
> /**
>diff --git a/drivers/net/ethernet/intel/ice/devlink/devlink_port.h
>b/drivers/net/ethernet/intel/ice/devlink/devlink_port.h
>index 6e14b9e4d621..28574e585341 100644
>--- a/drivers/net/ethernet/intel/ice/devlink/devlink_port.h
>+++ b/drivers/net/ethernet/intel/ice/devlink/devlink_port.h
>@@ -14,17 +14,23 @@
> * @devlink_port: the associated devlink port structure
> * @pf: pointer to the PF private structure
> * @vsi: the VSI associated with this port
>+ * @sf_dev: pointer to the subfunction device
> *
> * An instance of a dynamically added devlink port. Each port flavour
> */
> struct ice_dynamic_port {
> u8 hw_addr[ETH_ALEN];
> u8 active: 1;
>+ u8 attached: 1;
> struct devlink_port devlink_port;
> struct ice_pf *pf;
> struct ice_vsi *vsi;
> unsigned long repr_id;
> u32 sfnum;
>+ /* Flavour-specific implementation data */
>+ union {
>+ struct ice_sf_dev *sf_dev;
>+ };
> };
>
> void ice_dealloc_all_dynamic_ports(struct ice_pf *pf);
>diff --git a/drivers/net/ethernet/intel/ice/ice_sf_eth.c
>b/drivers/net/ethernet/intel/ice/ice_sf_eth.c
>index 3a540a2638d1..c01190c9403f 100644
>--- a/drivers/net/ethernet/intel/ice/ice_sf_eth.c
>+++ b/drivers/net/ethernet/intel/ice/ice_sf_eth.c
>@@ -147,6 +147,7 @@ static int ice_sf_dev_probe(struct auxiliary_device *adev,
> devl_unlock(devlink);
>
> devlink_register(devlink);
>+ dyn_port->attached = true;
>
> return 0;
>
>@@ -186,6 +187,8 @@ static void ice_sf_dev_remove(struct auxiliary_device
>*adev)
> devl_unlock(devlink);
> devlink_free(devlink);
> ice_vsi_decfg(vsi);
>+
>+ dyn_port->attached = false;
> }
>
> static const struct auxiliary_device_id ice_sf_dev_id_table[] = {
>@@ -202,6 +205,8 @@ static struct auxiliary_driver ice_sf_driver = {
> .id_table = ice_sf_dev_id_table
> };
>
>+static DEFINE_XARRAY_ALLOC1(ice_sf_aux_id);
>+
> /**
> * ice_sf_driver_register - Register new auxiliary subfunction driver
> *
>@@ -220,3 +225,105 @@ void ice_sf_driver_unregister(void)
> {
> auxiliary_driver_unregister(&ice_sf_driver);
> }
>+
>+/**
>+ * ice_sf_dev_release - Release device associated with auxiliary device
>+ * @device: pointer to the device
>+ *
>+ * Since most of the code for subfunction deactivation is handled in
>+ * the remove handler, here just free tracking resources.
>+ */
>+static void ice_sf_dev_release(struct device *device)
>+{
>+ struct auxiliary_device *adev = to_auxiliary_dev(device);
>+ struct ice_sf_dev *sf_dev = ice_adev_to_sf_dev(adev);
>+
>+ xa_erase(&ice_sf_aux_id, adev->id);
>+ kfree(sf_dev);
>+}
>+
>+/**
>+ * ice_sf_eth_activate - Activate Ethernet subfunction port
>+ * @dyn_port: the dynamic port instance for this subfunction
>+ * @extack: extack for reporting error messages
>+ *
>+ * Activate the dynamic port as an Ethernet subfunction. Setup the netdev
>+ * resources associated and initialize the auxiliary device.
>+ *
>+ * Return: zero on success or an error code on failure.
>+ */
>+int
>+ice_sf_eth_activate(struct ice_dynamic_port *dyn_port,
>+ struct netlink_ext_ack *extack)
>+{
>+ struct ice_pf *pf = dyn_port->pf;
>+ struct ice_sf_dev *sf_dev;
>+ struct pci_dev *pdev;
>+ int err;
>+ u32 id;
>+
>+ err = xa_alloc(&ice_sf_aux_id, &id, NULL, xa_limit_32b,
Double space.
>+ GFP_KERNEL);
>+ if (err) {
>+ NL_SET_ERR_MSG_MOD(extack, "Could not allocate subfunction ID");
>+ return err;
>+ }
>+
>+ sf_dev = kzalloc(sizeof(*sf_dev), GFP_KERNEL);
>+ if (!sf_dev) {
>+ err = -ENOMEM;
>+ NL_SET_ERR_MSG_MOD(extack, "Could not allocate sf_dev memory");
>+ goto xa_erase;
>+ }
>+ pdev = pf->pdev;
>+
>+ sf_dev->dyn_port = dyn_port;
>+ sf_dev->adev.id = id;
>+ sf_dev->adev.name = "sf";
>+ sf_dev->adev.dev.release = ice_sf_dev_release;
>+ sf_dev->adev.dev.parent = &pdev->dev;
>+
>+ err = auxiliary_device_init(&sf_dev->adev);
>+ if (err) {
>+ NL_SET_ERR_MSG_MOD(extack, "Failed to initialize auxiliary
>device");
>+ goto sf_dev_free;
>+ }
>+
>+ err = auxiliary_device_add(&sf_dev->adev);
>+ if (err) {
>+ NL_SET_ERR_MSG_MOD(extack, "Auxiliary device failed to probe");
How do you know? Probe may happen async.
>+ goto aux_dev_uninit;
>+ }
>+
>+ dyn_port->sf_dev = sf_dev;
>+
>+ return 0;
>+
>+aux_dev_uninit:
>+ auxiliary_device_uninit(&sf_dev->adev);
>+sf_dev_free:
>+ kfree(sf_dev);
>+xa_erase:
>+ xa_erase(&ice_sf_aux_id, id);
>+
>+ return err;
>+}
>+
>+/**
>+ * ice_sf_eth_deactivate - Deactivate Ethernet subfunction port
>+ * @dyn_port: the dynamic port instance for this subfunction
>+ *
>+ * Deactivate the Ethernet subfunction, removing its auxiliary device and the
>+ * associated resources.
>+ */
>+void ice_sf_eth_deactivate(struct ice_dynamic_port *dyn_port)
>+{
>+ struct ice_sf_dev *sf_dev = dyn_port->sf_dev;
>+
>+ if (sf_dev) {
>+ auxiliary_device_delete(&sf_dev->adev);
>+ auxiliary_device_uninit(&sf_dev->adev);
>+ }
>+
>+ dyn_port->sf_dev = NULL;
>+}
>diff --git a/drivers/net/ethernet/intel/ice/ice_sf_eth.h
>b/drivers/net/ethernet/intel/ice/ice_sf_eth.h
>index e972c50f96c9..c558cad0a183 100644
>--- a/drivers/net/ethernet/intel/ice/ice_sf_eth.h
>+++ b/drivers/net/ethernet/intel/ice/ice_sf_eth.h
>@@ -27,4 +27,7 @@ ice_sf_dev *ice_adev_to_sf_dev(struct auxiliary_device *adev)
> int ice_sf_driver_register(void);
> void ice_sf_driver_unregister(void);
>
>+int ice_sf_eth_activate(struct ice_dynamic_port *dyn_port,
>+ struct netlink_ext_ack *extack);
>+void ice_sf_eth_deactivate(struct ice_dynamic_port *dyn_port);
> #endif /* _ICE_SF_ETH_H_ */
>--
>2.42.0
>
>
