1 // SPDX-License-Identifier: GPL-2.0 2 /* Copyright (C) 2019-2021, Intel Corporation. */ 3 4 #include "ice.h" 5 #include "ice_eswitch.h" 6 #include "ice_devlink.h" 7 #include "ice_sriov.h" 8 #include "ice_tc_lib.h" 9 #include "ice_dcb_lib.h" 10 11 /** 12 * ice_repr_get_sw_port_id - get port ID associated with representor 13 * @repr: pointer to port representor 14 */ 15 static int ice_repr_get_sw_port_id(struct ice_repr *repr) 16 { 17 return repr->src_vsi->back->hw.port_info->lport; 18 } 19 20 /** 21 * ice_repr_get_phys_port_name - get phys port name 22 * @netdev: pointer to port representor netdev 23 * @buf: write here port name 24 * @len: max length of buf 25 */ 26 static int 27 ice_repr_get_phys_port_name(struct net_device *netdev, char *buf, size_t len) 28 { 29 struct ice_netdev_priv *np = netdev_priv(netdev); 30 struct ice_repr *repr = np->repr; 31 int res; 32 33 /* Devlink port is registered and devlink core is taking care of name formatting. */ 34 if (repr->vf->devlink_port.devlink) 35 return -EOPNOTSUPP; 36 37 res = snprintf(buf, len, "pf%dvfr%d", ice_repr_get_sw_port_id(repr), 38 repr->id); 39 if (res <= 0) 40 return -EOPNOTSUPP; 41 return 0; 42 } 43 44 /** 45 * ice_repr_get_stats64 - get VF stats for VFPR use 46 * @netdev: pointer to port representor netdev 47 * @stats: pointer to struct where stats can be stored 48 */ 49 static void 50 ice_repr_get_stats64(struct net_device *netdev, struct rtnl_link_stats64 *stats) 51 { 52 struct ice_netdev_priv *np = netdev_priv(netdev); 53 struct ice_eth_stats *eth_stats; 54 struct ice_vsi *vsi; 55 56 if (ice_is_vf_disabled(np->repr->vf)) 57 return; 58 vsi = np->repr->src_vsi; 59 60 ice_update_vsi_stats(vsi); 61 eth_stats = &vsi->eth_stats; 62 63 stats->tx_packets = eth_stats->tx_unicast + eth_stats->tx_broadcast + 64 eth_stats->tx_multicast; 65 stats->rx_packets = eth_stats->rx_unicast + eth_stats->rx_broadcast + 66 eth_stats->rx_multicast; 67 stats->tx_bytes = eth_stats->tx_bytes; 68 stats->rx_bytes = eth_stats->rx_bytes; 69 stats->multicast = eth_stats->rx_multicast; 70 stats->tx_errors = eth_stats->tx_errors; 71 stats->tx_dropped = eth_stats->tx_discards; 72 stats->rx_dropped = eth_stats->rx_discards; 73 } 74 75 /** 76 * ice_netdev_to_repr - Get port representor for given netdevice 77 * @netdev: pointer to port representor netdev 78 */ 79 struct ice_repr *ice_netdev_to_repr(struct net_device *netdev) 80 { 81 struct ice_netdev_priv *np = netdev_priv(netdev); 82 83 return np->repr; 84 } 85 86 /** 87 * ice_repr_open - Enable port representor's network interface 88 * @netdev: network interface device structure 89 * 90 * The open entry point is called when a port representor's network 91 * interface is made active by the system (IFF_UP). Corresponding 92 * VF is notified about link status change. 93 * 94 * Returns 0 on success 95 */ 96 static int ice_repr_open(struct net_device *netdev) 97 { 98 struct ice_repr *repr = ice_netdev_to_repr(netdev); 99 struct ice_vf *vf; 100 101 vf = repr->vf; 102 vf->link_forced = true; 103 vf->link_up = true; 104 ice_vc_notify_vf_link_state(vf); 105 106 netif_carrier_on(netdev); 107 netif_tx_start_all_queues(netdev); 108 109 return 0; 110 } 111 112 /** 113 * ice_repr_stop - Disable port representor's network interface 114 * @netdev: network interface device structure 115 * 116 * The stop entry point is called when a port representor's network 117 * interface is de-activated by the system. Corresponding 118 * VF is notified about link status change. 119 * 120 * Returns 0 on success 121 */ 122 static int ice_repr_stop(struct net_device *netdev) 123 { 124 struct ice_repr *repr = ice_netdev_to_repr(netdev); 125 struct ice_vf *vf; 126 127 vf = repr->vf; 128 vf->link_forced = true; 129 vf->link_up = false; 130 ice_vc_notify_vf_link_state(vf); 131 132 netif_carrier_off(netdev); 133 netif_tx_stop_all_queues(netdev); 134 135 return 0; 136 } 137 138 /** 139 * ice_repr_sp_stats64 - get slow path stats for port representor 140 * @dev: network interface device structure 141 * @stats: netlink stats structure 142 * 143 * RX/TX stats are being swapped here to be consistent with VF stats. In slow 144 * path, port representor receives data when the corresponding VF is sending it 145 * (and vice versa), TX and RX bytes/packets are effectively swapped on port 146 * representor. 147 */ 148 static int 149 ice_repr_sp_stats64(const struct net_device *dev, 150 struct rtnl_link_stats64 *stats) 151 { 152 struct ice_netdev_priv *np = netdev_priv(dev); 153 int vf_id = np->repr->vf->vf_id; 154 struct ice_tx_ring *tx_ring; 155 struct ice_rx_ring *rx_ring; 156 u64 pkts, bytes; 157 158 tx_ring = np->vsi->tx_rings[vf_id]; 159 ice_fetch_u64_stats_per_ring(&tx_ring->ring_stats->syncp, 160 tx_ring->ring_stats->stats, 161 &pkts, &bytes); 162 stats->rx_packets = pkts; 163 stats->rx_bytes = bytes; 164 165 rx_ring = np->vsi->rx_rings[vf_id]; 166 ice_fetch_u64_stats_per_ring(&rx_ring->ring_stats->syncp, 167 rx_ring->ring_stats->stats, 168 &pkts, &bytes); 169 stats->tx_packets = pkts; 170 stats->tx_bytes = bytes; 171 stats->tx_dropped = rx_ring->ring_stats->rx_stats.alloc_page_failed + 172 rx_ring->ring_stats->rx_stats.alloc_buf_failed; 173 174 return 0; 175 } 176 177 static bool 178 ice_repr_ndo_has_offload_stats(const struct net_device *dev, int attr_id) 179 { 180 return attr_id == IFLA_OFFLOAD_XSTATS_CPU_HIT; 181 } 182 183 static int 184 ice_repr_ndo_get_offload_stats(int attr_id, const struct net_device *dev, 185 void *sp) 186 { 187 if (attr_id == IFLA_OFFLOAD_XSTATS_CPU_HIT) 188 return ice_repr_sp_stats64(dev, (struct rtnl_link_stats64 *)sp); 189 190 return -EINVAL; 191 } 192 193 static int 194 ice_repr_setup_tc_cls_flower(struct ice_repr *repr, 195 struct flow_cls_offload *flower) 196 { 197 switch (flower->command) { 198 case FLOW_CLS_REPLACE: 199 return ice_add_cls_flower(repr->netdev, repr->src_vsi, flower); 200 case FLOW_CLS_DESTROY: 201 return ice_del_cls_flower(repr->src_vsi, flower); 202 default: 203 return -EINVAL; 204 } 205 } 206 207 static int 208 ice_repr_setup_tc_block_cb(enum tc_setup_type type, void *type_data, 209 void *cb_priv) 210 { 211 struct flow_cls_offload *flower = (struct flow_cls_offload *)type_data; 212 struct ice_netdev_priv *np = (struct ice_netdev_priv *)cb_priv; 213 214 switch (type) { 215 case TC_SETUP_CLSFLOWER: 216 return ice_repr_setup_tc_cls_flower(np->repr, flower); 217 default: 218 return -EOPNOTSUPP; 219 } 220 } 221 222 static LIST_HEAD(ice_repr_block_cb_list); 223 224 static int 225 ice_repr_setup_tc(struct net_device *netdev, enum tc_setup_type type, 226 void *type_data) 227 { 228 struct ice_netdev_priv *np = netdev_priv(netdev); 229 230 switch (type) { 231 case TC_SETUP_BLOCK: 232 return flow_block_cb_setup_simple((struct flow_block_offload *) 233 type_data, 234 &ice_repr_block_cb_list, 235 ice_repr_setup_tc_block_cb, 236 np, np, true); 237 default: 238 return -EOPNOTSUPP; 239 } 240 } 241 242 static const struct net_device_ops ice_repr_netdev_ops = { 243 .ndo_get_phys_port_name = ice_repr_get_phys_port_name, 244 .ndo_get_stats64 = ice_repr_get_stats64, 245 .ndo_open = ice_repr_open, 246 .ndo_stop = ice_repr_stop, 247 .ndo_start_xmit = ice_eswitch_port_start_xmit, 248 .ndo_setup_tc = ice_repr_setup_tc, 249 .ndo_has_offload_stats = ice_repr_ndo_has_offload_stats, 250 .ndo_get_offload_stats = ice_repr_ndo_get_offload_stats, 251 }; 252 253 /** 254 * ice_is_port_repr_netdev - Check if a given netdevice is a port representor netdev 255 * @netdev: pointer to netdev 256 */ 257 bool ice_is_port_repr_netdev(const struct net_device *netdev) 258 { 259 return netdev && (netdev->netdev_ops == &ice_repr_netdev_ops); 260 } 261 262 /** 263 * ice_repr_reg_netdev - register port representor netdev 264 * @netdev: pointer to port representor netdev 265 */ 266 static int 267 ice_repr_reg_netdev(struct net_device *netdev) 268 { 269 eth_hw_addr_random(netdev); 270 netdev->netdev_ops = &ice_repr_netdev_ops; 271 ice_set_ethtool_repr_ops(netdev); 272 273 netdev->hw_features |= NETIF_F_HW_TC; 274 275 netif_carrier_off(netdev); 276 netif_tx_stop_all_queues(netdev); 277 278 return register_netdev(netdev); 279 } 280 281 static void ice_repr_remove_node(struct devlink_port *devlink_port) 282 { 283 devl_lock(devlink_port->devlink); 284 devl_rate_leaf_destroy(devlink_port); 285 devl_unlock(devlink_port->devlink); 286 } 287 288 /** 289 * ice_repr_rem - remove representor from VF 290 * @repr: pointer to representor structure 291 */ 292 static void ice_repr_rem(struct ice_repr *repr) 293 { 294 kfree(repr->q_vector); 295 free_netdev(repr->netdev); 296 kfree(repr); 297 } 298 299 /** 300 * ice_repr_rem_vf - remove representor from VF 301 * @repr: pointer to representor structure 302 */ 303 void ice_repr_rem_vf(struct ice_repr *repr) 304 { 305 ice_repr_remove_node(&repr->vf->devlink_port); 306 unregister_netdev(repr->netdev); 307 ice_devlink_destroy_vf_port(repr->vf); 308 ice_virtchnl_set_dflt_ops(repr->vf); 309 ice_repr_rem(repr); 310 } 311 312 static void ice_repr_set_tx_topology(struct ice_pf *pf) 313 { 314 struct devlink *devlink; 315 316 /* only export if ADQ and DCB disabled and eswitch enabled*/ 317 if (ice_is_adq_active(pf) || ice_is_dcb_active(pf) || 318 !ice_is_switchdev_running(pf)) 319 return; 320 321 devlink = priv_to_devlink(pf); 322 ice_devlink_rate_init_tx_topology(devlink, ice_get_main_vsi(pf)); 323 } 324 325 /** 326 * ice_repr_add - add representor for generic VSI 327 * @pf: pointer to PF structure 328 * @src_vsi: pointer to VSI structure of device to represent 329 * @parent_mac: device MAC address 330 */ 331 static struct ice_repr * 332 ice_repr_add(struct ice_pf *pf, struct ice_vsi *src_vsi, const u8 *parent_mac) 333 { 334 struct ice_q_vector *q_vector; 335 struct ice_netdev_priv *np; 336 struct ice_repr *repr; 337 int err; 338 339 repr = kzalloc(sizeof(*repr), GFP_KERNEL); 340 if (!repr) 341 return ERR_PTR(-ENOMEM); 342 343 repr->netdev = alloc_etherdev(sizeof(struct ice_netdev_priv)); 344 if (!repr->netdev) { 345 err = -ENOMEM; 346 goto err_alloc; 347 } 348 349 repr->src_vsi = src_vsi; 350 np = netdev_priv(repr->netdev); 351 np->repr = repr; 352 353 q_vector = kzalloc(sizeof(*q_vector), GFP_KERNEL); 354 if (!q_vector) { 355 err = -ENOMEM; 356 goto err_alloc_q_vector; 357 } 358 repr->q_vector = q_vector; 359 repr->q_id = repr->id; 360 361 ether_addr_copy(repr->parent_mac, parent_mac); 362 363 return repr; 364 365 err_alloc_q_vector: 366 free_netdev(repr->netdev); 367 err_alloc: 368 kfree(repr); 369 return ERR_PTR(err); 370 } 371 372 struct ice_repr *ice_repr_add_vf(struct ice_vf *vf) 373 { 374 struct ice_repr *repr; 375 struct ice_vsi *vsi; 376 int err; 377 378 vsi = ice_get_vf_vsi(vf); 379 if (!vsi) 380 return ERR_PTR(-ENOENT); 381 382 err = ice_devlink_create_vf_port(vf); 383 if (err) 384 return ERR_PTR(err); 385 386 repr = ice_repr_add(vf->pf, vsi, vf->hw_lan_addr); 387 if (IS_ERR(repr)) { 388 err = PTR_ERR(repr); 389 goto err_repr_add; 390 } 391 392 repr->vf = vf; 393 394 repr->netdev->min_mtu = ETH_MIN_MTU; 395 repr->netdev->max_mtu = ICE_MAX_MTU; 396 397 SET_NETDEV_DEV(repr->netdev, ice_pf_to_dev(vf->pf)); 398 SET_NETDEV_DEVLINK_PORT(repr->netdev, &vf->devlink_port); 399 err = ice_repr_reg_netdev(repr->netdev); 400 if (err) 401 goto err_netdev; 402 403 ice_virtchnl_set_repr_ops(vf); 404 ice_repr_set_tx_topology(vf->pf); 405 406 return repr; 407 408 err_netdev: 409 ice_repr_rem(repr); 410 err_repr_add: 411 ice_devlink_destroy_vf_port(vf); 412 return ERR_PTR(err); 413 } 414 415 struct ice_repr *ice_repr_get_by_vsi(struct ice_vsi *vsi) 416 { 417 if (!vsi->vf) 418 return NULL; 419 420 return xa_load(&vsi->back->eswitch.reprs, vsi->vf->repr_id); 421 } 422 423 /** 424 * ice_repr_start_tx_queues - start Tx queues of port representor 425 * @repr: pointer to repr structure 426 */ 427 void ice_repr_start_tx_queues(struct ice_repr *repr) 428 { 429 netif_carrier_on(repr->netdev); 430 netif_tx_start_all_queues(repr->netdev); 431 } 432 433 /** 434 * ice_repr_stop_tx_queues - stop Tx queues of port representor 435 * @repr: pointer to repr structure 436 */ 437 void ice_repr_stop_tx_queues(struct ice_repr *repr) 438 { 439 netif_carrier_off(repr->netdev); 440 netif_tx_stop_all_queues(repr->netdev); 441 } 442 443 /** 444 * ice_repr_set_traffic_vsi - set traffic VSI for port representor 445 * @repr: repr on with VSI will be set 446 * @vsi: pointer to VSI that will be used by port representor to pass traffic 447 */ 448 void ice_repr_set_traffic_vsi(struct ice_repr *repr, struct ice_vsi *vsi) 449 { 450 struct ice_netdev_priv *np = netdev_priv(repr->netdev); 451 452 np->vsi = vsi; 453 } 454