1 // SPDX-License-Identifier: GPL-2.0 2 /* Copyright (c) 2024, Intel Corporation. */ 3 #include "ice.h" 4 #include "ice_lib.h" 5 #include "ice_txrx.h" 6 #include "ice_fltr.h" 7 #include "ice_sf_eth.h" 8 #include "devlink/devlink_port.h" 9 #include "devlink/devlink.h" 10 11 static const struct net_device_ops ice_sf_netdev_ops = { 12 .ndo_open = ice_open, 13 .ndo_stop = ice_stop, 14 .ndo_start_xmit = ice_start_xmit, 15 .ndo_vlan_rx_add_vid = ice_vlan_rx_add_vid, 16 .ndo_vlan_rx_kill_vid = ice_vlan_rx_kill_vid, 17 .ndo_change_mtu = ice_change_mtu, 18 .ndo_get_stats64 = ice_get_stats64, 19 .ndo_tx_timeout = ice_tx_timeout, 20 .ndo_bpf = ice_xdp, 21 .ndo_xdp_xmit = ice_xdp_xmit, 22 .ndo_xsk_wakeup = ice_xsk_wakeup, 23 }; 24 25 /** 26 * ice_sf_cfg_netdev - Allocate, configure and register a netdev 27 * @dyn_port: subfunction associated with configured netdev 28 * @devlink_port: subfunction devlink port to be linked with netdev 29 * 30 * Return: 0 on success, negative value on failure 31 */ 32 static int ice_sf_cfg_netdev(struct ice_dynamic_port *dyn_port, 33 struct devlink_port *devlink_port) 34 { 35 struct ice_vsi *vsi = dyn_port->vsi; 36 struct ice_netdev_priv *np; 37 struct net_device *netdev; 38 int err; 39 40 netdev = alloc_etherdev_mqs(sizeof(*np), vsi->alloc_txq, 41 vsi->alloc_rxq); 42 if (!netdev) 43 return -ENOMEM; 44 45 SET_NETDEV_DEV(netdev, &vsi->back->pdev->dev); 46 set_bit(ICE_VSI_NETDEV_ALLOCD, vsi->state); 47 vsi->netdev = netdev; 48 np = netdev_priv(netdev); 49 np->vsi = vsi; 50 51 ice_set_netdev_features(netdev); 52 53 netdev->xdp_features = NETDEV_XDP_ACT_BASIC | NETDEV_XDP_ACT_REDIRECT | 54 NETDEV_XDP_ACT_XSK_ZEROCOPY | 55 NETDEV_XDP_ACT_RX_SG; 56 netdev->xdp_zc_max_segs = ICE_MAX_BUF_TXD; 57 58 eth_hw_addr_set(netdev, dyn_port->hw_addr); 59 ether_addr_copy(netdev->perm_addr, dyn_port->hw_addr); 60 netdev->netdev_ops = &ice_sf_netdev_ops; 61 SET_NETDEV_DEVLINK_PORT(netdev, devlink_port); 62 63 err = register_netdev(netdev); 64 if (err) { 65 free_netdev(netdev); 66 vsi->netdev = NULL; 67 return -ENOMEM; 68 } 69 set_bit(ICE_VSI_NETDEV_REGISTERED, vsi->state); 70 netif_carrier_off(netdev); 71 netif_tx_stop_all_queues(netdev); 72 73 return 0; 74 } 75 76 static void ice_sf_decfg_netdev(struct ice_vsi *vsi) 77 { 78 unregister_netdev(vsi->netdev); 79 clear_bit(ICE_VSI_NETDEV_REGISTERED, vsi->state); 80 free_netdev(vsi->netdev); 81 vsi->netdev = NULL; 82 clear_bit(ICE_VSI_NETDEV_ALLOCD, vsi->state); 83 } 84 85 /** 86 * ice_sf_dev_probe - subfunction driver probe function 87 * @adev: pointer to the auxiliary device 88 * @id: pointer to the auxiliary_device id 89 * 90 * Configure VSI and netdev resources for the subfunction device. 91 * 92 * Return: zero on success or an error code on failure. 93 */ 94 static int ice_sf_dev_probe(struct auxiliary_device *adev, 95 const struct auxiliary_device_id *id) 96 { 97 struct ice_sf_dev *sf_dev = ice_adev_to_sf_dev(adev); 98 struct ice_dynamic_port *dyn_port = sf_dev->dyn_port; 99 struct ice_vsi *vsi = dyn_port->vsi; 100 struct ice_pf *pf = dyn_port->pf; 101 struct device *dev = &adev->dev; 102 struct ice_sf_priv *priv; 103 struct devlink *devlink; 104 int err; 105 106 vsi->type = ICE_VSI_SF; 107 vsi->port_info = pf->hw.port_info; 108 vsi->flags = ICE_VSI_FLAG_INIT; 109 110 priv = ice_allocate_sf(&adev->dev, pf); 111 if (!priv) { 112 dev_err(dev, "Subfunction devlink alloc failed"); 113 return -ENOMEM; 114 } 115 116 priv->dev = sf_dev; 117 sf_dev->priv = priv; 118 devlink = priv_to_devlink(priv); 119 120 devl_lock(devlink); 121 122 err = ice_vsi_cfg(vsi); 123 if (err) { 124 dev_err(dev, "Subfunction vsi config failed"); 125 goto err_free_devlink; 126 } 127 vsi->sf = dyn_port; 128 129 err = ice_devlink_create_sf_dev_port(sf_dev); 130 if (err) { 131 dev_err(dev, "Cannot add ice virtual devlink port for subfunction"); 132 goto err_vsi_decfg; 133 } 134 135 err = ice_sf_cfg_netdev(dyn_port, &sf_dev->priv->devlink_port); 136 if (err) { 137 dev_err(dev, "Subfunction netdev config failed"); 138 goto err_devlink_destroy; 139 } 140 141 err = devl_port_fn_devlink_set(&dyn_port->devlink_port, devlink); 142 if (err) { 143 dev_err(dev, "Can't link devlink instance to SF devlink port"); 144 goto err_netdev_decfg; 145 } 146 147 ice_napi_add(vsi); 148 149 devl_register(devlink); 150 devl_unlock(devlink); 151 152 return 0; 153 154 err_netdev_decfg: 155 ice_sf_decfg_netdev(vsi); 156 err_devlink_destroy: 157 ice_devlink_destroy_sf_dev_port(sf_dev); 158 err_vsi_decfg: 159 ice_vsi_decfg(vsi); 160 err_free_devlink: 161 devl_unlock(devlink); 162 devlink_free(devlink); 163 return err; 164 } 165 166 /** 167 * ice_sf_dev_remove - subfunction driver remove function 168 * @adev: pointer to the auxiliary device 169 * 170 * Deinitalize VSI and netdev resources for the subfunction device. 171 */ 172 static void ice_sf_dev_remove(struct auxiliary_device *adev) 173 { 174 struct ice_sf_dev *sf_dev = ice_adev_to_sf_dev(adev); 175 struct ice_dynamic_port *dyn_port = sf_dev->dyn_port; 176 struct ice_vsi *vsi = dyn_port->vsi; 177 struct devlink *devlink; 178 179 devlink = priv_to_devlink(sf_dev->priv); 180 devl_lock(devlink); 181 182 ice_vsi_close(vsi); 183 184 ice_sf_decfg_netdev(vsi); 185 ice_devlink_destroy_sf_dev_port(sf_dev); 186 devl_unregister(devlink); 187 devl_unlock(devlink); 188 devlink_free(devlink); 189 ice_vsi_decfg(vsi); 190 } 191 192 static const struct auxiliary_device_id ice_sf_dev_id_table[] = { 193 { .name = "ice.sf", }, 194 { }, 195 }; 196 197 MODULE_DEVICE_TABLE(auxiliary, ice_sf_dev_id_table); 198 199 static struct auxiliary_driver ice_sf_driver = { 200 .name = "sf", 201 .probe = ice_sf_dev_probe, 202 .remove = ice_sf_dev_remove, 203 .id_table = ice_sf_dev_id_table 204 }; 205 206 /** 207 * ice_sf_driver_register - Register new auxiliary subfunction driver 208 * 209 * Return: zero on success or an error code on failure. 210 */ 211 int ice_sf_driver_register(void) 212 { 213 return auxiliary_driver_register(&ice_sf_driver); 214 } 215 216 /** 217 * ice_sf_driver_unregister - Unregister new auxiliary subfunction driver 218 * 219 */ 220 void ice_sf_driver_unregister(void) 221 { 222 auxiliary_driver_unregister(&ice_sf_driver); 223 } 224