1 // SPDX-License-Identifier: GPL-2.0 2 /* Copyright (c) 2018, Intel Corporation. */ 3 4 /* Intel(R) Ethernet Connection E800 Series Linux Driver */ 5 6 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt 7 8 #include <generated/utsrelease.h> 9 #include "ice.h" 10 #include "ice_base.h" 11 #include "ice_lib.h" 12 #include "ice_fltr.h" 13 #include "ice_dcb_lib.h" 14 #include "ice_dcb_nl.h" 15 #include "ice_devlink.h" 16 /* Including ice_trace.h with CREATE_TRACE_POINTS defined will generate the 17 * ice tracepoint functions. This must be done exactly once across the 18 * ice driver. 19 */ 20 #define CREATE_TRACE_POINTS 21 #include "ice_trace.h" 22 #include "ice_eswitch.h" 23 #include "ice_tc_lib.h" 24 #include "ice_vsi_vlan_ops.h" 25 26 #define DRV_SUMMARY "Intel(R) Ethernet Connection E800 Series Linux Driver" 27 static const char ice_driver_string[] = DRV_SUMMARY; 28 static const char ice_copyright[] = "Copyright (c) 2018, Intel Corporation."; 29 30 /* DDP Package file located in firmware search paths (e.g. /lib/firmware/) */ 31 #define ICE_DDP_PKG_PATH "intel/ice/ddp/" 32 #define ICE_DDP_PKG_FILE ICE_DDP_PKG_PATH "ice.pkg" 33 34 MODULE_AUTHOR("Intel Corporation, <linux.nics@intel.com>"); 35 MODULE_DESCRIPTION(DRV_SUMMARY); 36 MODULE_LICENSE("GPL v2"); 37 MODULE_FIRMWARE(ICE_DDP_PKG_FILE); 38 39 static int debug = -1; 40 module_param(debug, int, 0644); 41 #ifndef CONFIG_DYNAMIC_DEBUG 42 MODULE_PARM_DESC(debug, "netif level (0=none,...,16=all), hw debug_mask (0x8XXXXXXX)"); 43 #else 44 MODULE_PARM_DESC(debug, "netif level (0=none,...,16=all)"); 45 #endif /* !CONFIG_DYNAMIC_DEBUG */ 46 47 static DEFINE_IDA(ice_aux_ida); 48 DEFINE_STATIC_KEY_FALSE(ice_xdp_locking_key); 49 EXPORT_SYMBOL(ice_xdp_locking_key); 50 51 /** 52 * ice_hw_to_dev - Get device pointer from the hardware structure 53 * @hw: pointer to the device HW structure 54 * 55 * Used to access the device pointer from compilation units which can't easily 56 * include the definition of struct ice_pf without leading to circular header 57 * dependencies. 58 */ 59 struct device *ice_hw_to_dev(struct ice_hw *hw) 60 { 61 struct ice_pf *pf = container_of(hw, struct ice_pf, hw); 62 63 return &pf->pdev->dev; 64 } 65 66 static struct workqueue_struct *ice_wq; 67 static const struct net_device_ops ice_netdev_safe_mode_ops; 68 static const struct net_device_ops ice_netdev_ops; 69 70 static void ice_rebuild(struct ice_pf *pf, enum ice_reset_req reset_type); 71 72 static void ice_vsi_release_all(struct ice_pf *pf); 73 74 static int ice_rebuild_channels(struct ice_pf *pf); 75 static void ice_remove_q_channels(struct ice_vsi *vsi, bool rem_adv_fltr); 76 77 static int 78 ice_indr_setup_tc_cb(struct net_device *netdev, struct Qdisc *sch, 79 void *cb_priv, enum tc_setup_type type, void *type_data, 80 void *data, 81 void (*cleanup)(struct flow_block_cb *block_cb)); 82 83 bool netif_is_ice(struct net_device *dev) 84 { 85 return dev && (dev->netdev_ops == &ice_netdev_ops); 86 } 87 88 /** 89 * ice_get_tx_pending - returns number of Tx descriptors not processed 90 * @ring: the ring of descriptors 91 */ 92 static u16 ice_get_tx_pending(struct ice_tx_ring *ring) 93 { 94 u16 head, tail; 95 96 head = ring->next_to_clean; 97 tail = ring->next_to_use; 98 99 if (head != tail) 100 return (head < tail) ? 101 tail - head : (tail + ring->count - head); 102 return 0; 103 } 104 105 /** 106 * ice_check_for_hang_subtask - check for and recover hung queues 107 * @pf: pointer to PF struct 108 */ 109 static void ice_check_for_hang_subtask(struct ice_pf *pf) 110 { 111 struct ice_vsi *vsi = NULL; 112 struct ice_hw *hw; 113 unsigned int i; 114 int packets; 115 u32 v; 116 117 ice_for_each_vsi(pf, v) 118 if (pf->vsi[v] && pf->vsi[v]->type == ICE_VSI_PF) { 119 vsi = pf->vsi[v]; 120 break; 121 } 122 123 if (!vsi || test_bit(ICE_VSI_DOWN, vsi->state)) 124 return; 125 126 if (!(vsi->netdev && netif_carrier_ok(vsi->netdev))) 127 return; 128 129 hw = &vsi->back->hw; 130 131 ice_for_each_txq(vsi, i) { 132 struct ice_tx_ring *tx_ring = vsi->tx_rings[i]; 133 134 if (!tx_ring) 135 continue; 136 if (ice_ring_ch_enabled(tx_ring)) 137 continue; 138 139 if (tx_ring->desc) { 140 /* If packet counter has not changed the queue is 141 * likely stalled, so force an interrupt for this 142 * queue. 143 * 144 * prev_pkt would be negative if there was no 145 * pending work. 146 */ 147 packets = tx_ring->stats.pkts & INT_MAX; 148 if (tx_ring->tx_stats.prev_pkt == packets) { 149 /* Trigger sw interrupt to revive the queue */ 150 ice_trigger_sw_intr(hw, tx_ring->q_vector); 151 continue; 152 } 153 154 /* Memory barrier between read of packet count and call 155 * to ice_get_tx_pending() 156 */ 157 smp_rmb(); 158 tx_ring->tx_stats.prev_pkt = 159 ice_get_tx_pending(tx_ring) ? packets : -1; 160 } 161 } 162 } 163 164 /** 165 * ice_init_mac_fltr - Set initial MAC filters 166 * @pf: board private structure 167 * 168 * Set initial set of MAC filters for PF VSI; configure filters for permanent 169 * address and broadcast address. If an error is encountered, netdevice will be 170 * unregistered. 171 */ 172 static int ice_init_mac_fltr(struct ice_pf *pf) 173 { 174 struct ice_vsi *vsi; 175 u8 *perm_addr; 176 177 vsi = ice_get_main_vsi(pf); 178 if (!vsi) 179 return -EINVAL; 180 181 perm_addr = vsi->port_info->mac.perm_addr; 182 return ice_fltr_add_mac_and_broadcast(vsi, perm_addr, ICE_FWD_TO_VSI); 183 } 184 185 /** 186 * ice_add_mac_to_sync_list - creates list of MAC addresses to be synced 187 * @netdev: the net device on which the sync is happening 188 * @addr: MAC address to sync 189 * 190 * This is a callback function which is called by the in kernel device sync 191 * functions (like __dev_uc_sync, __dev_mc_sync, etc). This function only 192 * populates the tmp_sync_list, which is later used by ice_add_mac to add the 193 * MAC filters from the hardware. 194 */ 195 static int ice_add_mac_to_sync_list(struct net_device *netdev, const u8 *addr) 196 { 197 struct ice_netdev_priv *np = netdev_priv(netdev); 198 struct ice_vsi *vsi = np->vsi; 199 200 if (ice_fltr_add_mac_to_list(vsi, &vsi->tmp_sync_list, addr, 201 ICE_FWD_TO_VSI)) 202 return -EINVAL; 203 204 return 0; 205 } 206 207 /** 208 * ice_add_mac_to_unsync_list - creates list of MAC addresses to be unsynced 209 * @netdev: the net device on which the unsync is happening 210 * @addr: MAC address to unsync 211 * 212 * This is a callback function which is called by the in kernel device unsync 213 * functions (like __dev_uc_unsync, __dev_mc_unsync, etc). This function only 214 * populates the tmp_unsync_list, which is later used by ice_remove_mac to 215 * delete the MAC filters from the hardware. 216 */ 217 static int ice_add_mac_to_unsync_list(struct net_device *netdev, const u8 *addr) 218 { 219 struct ice_netdev_priv *np = netdev_priv(netdev); 220 struct ice_vsi *vsi = np->vsi; 221 222 /* Under some circumstances, we might receive a request to delete our 223 * own device address from our uc list. Because we store the device 224 * address in the VSI's MAC filter list, we need to ignore such 225 * requests and not delete our device address from this list. 226 */ 227 if (ether_addr_equal(addr, netdev->dev_addr)) 228 return 0; 229 230 if (ice_fltr_add_mac_to_list(vsi, &vsi->tmp_unsync_list, addr, 231 ICE_FWD_TO_VSI)) 232 return -EINVAL; 233 234 return 0; 235 } 236 237 /** 238 * ice_vsi_fltr_changed - check if filter state changed 239 * @vsi: VSI to be checked 240 * 241 * returns true if filter state has changed, false otherwise. 242 */ 243 static bool ice_vsi_fltr_changed(struct ice_vsi *vsi) 244 { 245 return test_bit(ICE_VSI_UMAC_FLTR_CHANGED, vsi->state) || 246 test_bit(ICE_VSI_MMAC_FLTR_CHANGED, vsi->state); 247 } 248 249 /** 250 * ice_set_promisc - Enable promiscuous mode for a given PF 251 * @vsi: the VSI being configured 252 * @promisc_m: mask of promiscuous config bits 253 * 254 */ 255 static int ice_set_promisc(struct ice_vsi *vsi, u8 promisc_m) 256 { 257 int status; 258 259 if (vsi->type != ICE_VSI_PF) 260 return 0; 261 262 if (ice_vsi_has_non_zero_vlans(vsi)) { 263 promisc_m |= (ICE_PROMISC_VLAN_RX | ICE_PROMISC_VLAN_TX); 264 status = ice_fltr_set_vlan_vsi_promisc(&vsi->back->hw, vsi, 265 promisc_m); 266 } else { 267 status = ice_fltr_set_vsi_promisc(&vsi->back->hw, vsi->idx, 268 promisc_m, 0); 269 } 270 271 return status; 272 } 273 274 /** 275 * ice_clear_promisc - Disable promiscuous mode for a given PF 276 * @vsi: the VSI being configured 277 * @promisc_m: mask of promiscuous config bits 278 * 279 */ 280 static int ice_clear_promisc(struct ice_vsi *vsi, u8 promisc_m) 281 { 282 int status; 283 284 if (vsi->type != ICE_VSI_PF) 285 return 0; 286 287 if (ice_vsi_has_non_zero_vlans(vsi)) { 288 promisc_m |= (ICE_PROMISC_VLAN_RX | ICE_PROMISC_VLAN_TX); 289 status = ice_fltr_clear_vlan_vsi_promisc(&vsi->back->hw, vsi, 290 promisc_m); 291 } else { 292 status = ice_fltr_clear_vsi_promisc(&vsi->back->hw, vsi->idx, 293 promisc_m, 0); 294 } 295 296 return status; 297 } 298 299 /** 300 * ice_get_devlink_port - Get devlink port from netdev 301 * @netdev: the netdevice structure 302 */ 303 static struct devlink_port *ice_get_devlink_port(struct net_device *netdev) 304 { 305 struct ice_pf *pf = ice_netdev_to_pf(netdev); 306 307 if (!ice_is_switchdev_running(pf)) 308 return NULL; 309 310 return &pf->devlink_port; 311 } 312 313 /** 314 * ice_vsi_sync_fltr - Update the VSI filter list to the HW 315 * @vsi: ptr to the VSI 316 * 317 * Push any outstanding VSI filter changes through the AdminQ. 318 */ 319 static int ice_vsi_sync_fltr(struct ice_vsi *vsi) 320 { 321 struct ice_vsi_vlan_ops *vlan_ops = ice_get_compat_vsi_vlan_ops(vsi); 322 struct device *dev = ice_pf_to_dev(vsi->back); 323 struct net_device *netdev = vsi->netdev; 324 bool promisc_forced_on = false; 325 struct ice_pf *pf = vsi->back; 326 struct ice_hw *hw = &pf->hw; 327 u32 changed_flags = 0; 328 int err; 329 330 if (!vsi->netdev) 331 return -EINVAL; 332 333 while (test_and_set_bit(ICE_CFG_BUSY, vsi->state)) 334 usleep_range(1000, 2000); 335 336 changed_flags = vsi->current_netdev_flags ^ vsi->netdev->flags; 337 vsi->current_netdev_flags = vsi->netdev->flags; 338 339 INIT_LIST_HEAD(&vsi->tmp_sync_list); 340 INIT_LIST_HEAD(&vsi->tmp_unsync_list); 341 342 if (ice_vsi_fltr_changed(vsi)) { 343 clear_bit(ICE_VSI_UMAC_FLTR_CHANGED, vsi->state); 344 clear_bit(ICE_VSI_MMAC_FLTR_CHANGED, vsi->state); 345 346 /* grab the netdev's addr_list_lock */ 347 netif_addr_lock_bh(netdev); 348 __dev_uc_sync(netdev, ice_add_mac_to_sync_list, 349 ice_add_mac_to_unsync_list); 350 __dev_mc_sync(netdev, ice_add_mac_to_sync_list, 351 ice_add_mac_to_unsync_list); 352 /* our temp lists are populated. release lock */ 353 netif_addr_unlock_bh(netdev); 354 } 355 356 /* Remove MAC addresses in the unsync list */ 357 err = ice_fltr_remove_mac_list(vsi, &vsi->tmp_unsync_list); 358 ice_fltr_free_list(dev, &vsi->tmp_unsync_list); 359 if (err) { 360 netdev_err(netdev, "Failed to delete MAC filters\n"); 361 /* if we failed because of alloc failures, just bail */ 362 if (err == -ENOMEM) 363 goto out; 364 } 365 366 /* Add MAC addresses in the sync list */ 367 err = ice_fltr_add_mac_list(vsi, &vsi->tmp_sync_list); 368 ice_fltr_free_list(dev, &vsi->tmp_sync_list); 369 /* If filter is added successfully or already exists, do not go into 370 * 'if' condition and report it as error. Instead continue processing 371 * rest of the function. 372 */ 373 if (err && err != -EEXIST) { 374 netdev_err(netdev, "Failed to add MAC filters\n"); 375 /* If there is no more space for new umac filters, VSI 376 * should go into promiscuous mode. There should be some 377 * space reserved for promiscuous filters. 378 */ 379 if (hw->adminq.sq_last_status == ICE_AQ_RC_ENOSPC && 380 !test_and_set_bit(ICE_FLTR_OVERFLOW_PROMISC, 381 vsi->state)) { 382 promisc_forced_on = true; 383 netdev_warn(netdev, "Reached MAC filter limit, forcing promisc mode on VSI %d\n", 384 vsi->vsi_num); 385 } else { 386 goto out; 387 } 388 } 389 err = 0; 390 /* check for changes in promiscuous modes */ 391 if (changed_flags & IFF_ALLMULTI) { 392 if (vsi->current_netdev_flags & IFF_ALLMULTI) { 393 err = ice_set_promisc(vsi, ICE_MCAST_PROMISC_BITS); 394 if (err) { 395 vsi->current_netdev_flags &= ~IFF_ALLMULTI; 396 goto out_promisc; 397 } 398 } else { 399 /* !(vsi->current_netdev_flags & IFF_ALLMULTI) */ 400 err = ice_clear_promisc(vsi, ICE_MCAST_PROMISC_BITS); 401 if (err) { 402 vsi->current_netdev_flags |= IFF_ALLMULTI; 403 goto out_promisc; 404 } 405 } 406 } 407 408 if (((changed_flags & IFF_PROMISC) || promisc_forced_on) || 409 test_bit(ICE_VSI_PROMISC_CHANGED, vsi->state)) { 410 clear_bit(ICE_VSI_PROMISC_CHANGED, vsi->state); 411 if (vsi->current_netdev_flags & IFF_PROMISC) { 412 /* Apply Rx filter rule to get traffic from wire */ 413 if (!ice_is_dflt_vsi_in_use(pf->first_sw)) { 414 err = ice_set_dflt_vsi(pf->first_sw, vsi); 415 if (err && err != -EEXIST) { 416 netdev_err(netdev, "Error %d setting default VSI %i Rx rule\n", 417 err, vsi->vsi_num); 418 vsi->current_netdev_flags &= 419 ~IFF_PROMISC; 420 goto out_promisc; 421 } 422 err = 0; 423 vlan_ops->dis_rx_filtering(vsi); 424 } 425 } else { 426 /* Clear Rx filter to remove traffic from wire */ 427 if (ice_is_vsi_dflt_vsi(pf->first_sw, vsi)) { 428 err = ice_clear_dflt_vsi(pf->first_sw); 429 if (err) { 430 netdev_err(netdev, "Error %d clearing default VSI %i Rx rule\n", 431 err, vsi->vsi_num); 432 vsi->current_netdev_flags |= 433 IFF_PROMISC; 434 goto out_promisc; 435 } 436 if (vsi->current_netdev_flags & 437 NETIF_F_HW_VLAN_CTAG_FILTER) 438 vlan_ops->ena_rx_filtering(vsi); 439 } 440 } 441 } 442 goto exit; 443 444 out_promisc: 445 set_bit(ICE_VSI_PROMISC_CHANGED, vsi->state); 446 goto exit; 447 out: 448 /* if something went wrong then set the changed flag so we try again */ 449 set_bit(ICE_VSI_UMAC_FLTR_CHANGED, vsi->state); 450 set_bit(ICE_VSI_MMAC_FLTR_CHANGED, vsi->state); 451 exit: 452 clear_bit(ICE_CFG_BUSY, vsi->state); 453 return err; 454 } 455 456 /** 457 * ice_sync_fltr_subtask - Sync the VSI filter list with HW 458 * @pf: board private structure 459 */ 460 static void ice_sync_fltr_subtask(struct ice_pf *pf) 461 { 462 int v; 463 464 if (!pf || !(test_bit(ICE_FLAG_FLTR_SYNC, pf->flags))) 465 return; 466 467 clear_bit(ICE_FLAG_FLTR_SYNC, pf->flags); 468 469 ice_for_each_vsi(pf, v) 470 if (pf->vsi[v] && ice_vsi_fltr_changed(pf->vsi[v]) && 471 ice_vsi_sync_fltr(pf->vsi[v])) { 472 /* come back and try again later */ 473 set_bit(ICE_FLAG_FLTR_SYNC, pf->flags); 474 break; 475 } 476 } 477 478 /** 479 * ice_pf_dis_all_vsi - Pause all VSIs on a PF 480 * @pf: the PF 481 * @locked: is the rtnl_lock already held 482 */ 483 static void ice_pf_dis_all_vsi(struct ice_pf *pf, bool locked) 484 { 485 int node; 486 int v; 487 488 ice_for_each_vsi(pf, v) 489 if (pf->vsi[v]) 490 ice_dis_vsi(pf->vsi[v], locked); 491 492 for (node = 0; node < ICE_MAX_PF_AGG_NODES; node++) 493 pf->pf_agg_node[node].num_vsis = 0; 494 495 for (node = 0; node < ICE_MAX_VF_AGG_NODES; node++) 496 pf->vf_agg_node[node].num_vsis = 0; 497 } 498 499 /** 500 * ice_clear_sw_switch_recipes - clear switch recipes 501 * @pf: board private structure 502 * 503 * Mark switch recipes as not created in sw structures. There are cases where 504 * rules (especially advanced rules) need to be restored, either re-read from 505 * hardware or added again. For example after the reset. 'recp_created' flag 506 * prevents from doing that and need to be cleared upfront. 507 */ 508 static void ice_clear_sw_switch_recipes(struct ice_pf *pf) 509 { 510 struct ice_sw_recipe *recp; 511 u8 i; 512 513 recp = pf->hw.switch_info->recp_list; 514 for (i = 0; i < ICE_MAX_NUM_RECIPES; i++) 515 recp[i].recp_created = false; 516 } 517 518 /** 519 * ice_prepare_for_reset - prep for reset 520 * @pf: board private structure 521 * @reset_type: reset type requested 522 * 523 * Inform or close all dependent features in prep for reset. 524 */ 525 static void 526 ice_prepare_for_reset(struct ice_pf *pf, enum ice_reset_req reset_type) 527 { 528 struct ice_hw *hw = &pf->hw; 529 struct ice_vsi *vsi; 530 struct ice_vf *vf; 531 unsigned int bkt; 532 533 dev_dbg(ice_pf_to_dev(pf), "reset_type=%d\n", reset_type); 534 535 /* already prepared for reset */ 536 if (test_bit(ICE_PREPARED_FOR_RESET, pf->state)) 537 return; 538 539 ice_unplug_aux_dev(pf); 540 541 /* Notify VFs of impending reset */ 542 if (ice_check_sq_alive(hw, &hw->mailboxq)) 543 ice_vc_notify_reset(pf); 544 545 /* Disable VFs until reset is completed */ 546 mutex_lock(&pf->vfs.table_lock); 547 ice_for_each_vf(pf, bkt, vf) 548 ice_set_vf_state_qs_dis(vf); 549 mutex_unlock(&pf->vfs.table_lock); 550 551 if (ice_is_eswitch_mode_switchdev(pf)) { 552 if (reset_type != ICE_RESET_PFR) 553 ice_clear_sw_switch_recipes(pf); 554 } 555 556 /* release ADQ specific HW and SW resources */ 557 vsi = ice_get_main_vsi(pf); 558 if (!vsi) 559 goto skip; 560 561 /* to be on safe side, reset orig_rss_size so that normal flow 562 * of deciding rss_size can take precedence 563 */ 564 vsi->orig_rss_size = 0; 565 566 if (test_bit(ICE_FLAG_TC_MQPRIO, pf->flags)) { 567 if (reset_type == ICE_RESET_PFR) { 568 vsi->old_ena_tc = vsi->all_enatc; 569 vsi->old_numtc = vsi->all_numtc; 570 } else { 571 ice_remove_q_channels(vsi, true); 572 573 /* for other reset type, do not support channel rebuild 574 * hence reset needed info 575 */ 576 vsi->old_ena_tc = 0; 577 vsi->all_enatc = 0; 578 vsi->old_numtc = 0; 579 vsi->all_numtc = 0; 580 vsi->req_txq = 0; 581 vsi->req_rxq = 0; 582 clear_bit(ICE_FLAG_TC_MQPRIO, pf->flags); 583 memset(&vsi->mqprio_qopt, 0, sizeof(vsi->mqprio_qopt)); 584 } 585 } 586 skip: 587 588 /* clear SW filtering DB */ 589 ice_clear_hw_tbls(hw); 590 /* disable the VSIs and their queues that are not already DOWN */ 591 ice_pf_dis_all_vsi(pf, false); 592 593 if (test_bit(ICE_FLAG_PTP_SUPPORTED, pf->flags)) 594 ice_ptp_prepare_for_reset(pf); 595 596 if (ice_is_feature_supported(pf, ICE_F_GNSS)) 597 ice_gnss_exit(pf); 598 599 if (hw->port_info) 600 ice_sched_clear_port(hw->port_info); 601 602 ice_shutdown_all_ctrlq(hw); 603 604 set_bit(ICE_PREPARED_FOR_RESET, pf->state); 605 } 606 607 /** 608 * ice_do_reset - Initiate one of many types of resets 609 * @pf: board private structure 610 * @reset_type: reset type requested before this function was called. 611 */ 612 static void ice_do_reset(struct ice_pf *pf, enum ice_reset_req reset_type) 613 { 614 struct device *dev = ice_pf_to_dev(pf); 615 struct ice_hw *hw = &pf->hw; 616 617 dev_dbg(dev, "reset_type 0x%x requested\n", reset_type); 618 619 ice_prepare_for_reset(pf, reset_type); 620 621 /* trigger the reset */ 622 if (ice_reset(hw, reset_type)) { 623 dev_err(dev, "reset %d failed\n", reset_type); 624 set_bit(ICE_RESET_FAILED, pf->state); 625 clear_bit(ICE_RESET_OICR_RECV, pf->state); 626 clear_bit(ICE_PREPARED_FOR_RESET, pf->state); 627 clear_bit(ICE_PFR_REQ, pf->state); 628 clear_bit(ICE_CORER_REQ, pf->state); 629 clear_bit(ICE_GLOBR_REQ, pf->state); 630 wake_up(&pf->reset_wait_queue); 631 return; 632 } 633 634 /* PFR is a bit of a special case because it doesn't result in an OICR 635 * interrupt. So for PFR, rebuild after the reset and clear the reset- 636 * associated state bits. 637 */ 638 if (reset_type == ICE_RESET_PFR) { 639 pf->pfr_count++; 640 ice_rebuild(pf, reset_type); 641 clear_bit(ICE_PREPARED_FOR_RESET, pf->state); 642 clear_bit(ICE_PFR_REQ, pf->state); 643 wake_up(&pf->reset_wait_queue); 644 ice_reset_all_vfs(pf); 645 } 646 } 647 648 /** 649 * ice_reset_subtask - Set up for resetting the device and driver 650 * @pf: board private structure 651 */ 652 static void ice_reset_subtask(struct ice_pf *pf) 653 { 654 enum ice_reset_req reset_type = ICE_RESET_INVAL; 655 656 /* When a CORER/GLOBR/EMPR is about to happen, the hardware triggers an 657 * OICR interrupt. The OICR handler (ice_misc_intr) determines what type 658 * of reset is pending and sets bits in pf->state indicating the reset 659 * type and ICE_RESET_OICR_RECV. So, if the latter bit is set 660 * prepare for pending reset if not already (for PF software-initiated 661 * global resets the software should already be prepared for it as 662 * indicated by ICE_PREPARED_FOR_RESET; for global resets initiated 663 * by firmware or software on other PFs, that bit is not set so prepare 664 * for the reset now), poll for reset done, rebuild and return. 665 */ 666 if (test_bit(ICE_RESET_OICR_RECV, pf->state)) { 667 /* Perform the largest reset requested */ 668 if (test_and_clear_bit(ICE_CORER_RECV, pf->state)) 669 reset_type = ICE_RESET_CORER; 670 if (test_and_clear_bit(ICE_GLOBR_RECV, pf->state)) 671 reset_type = ICE_RESET_GLOBR; 672 if (test_and_clear_bit(ICE_EMPR_RECV, pf->state)) 673 reset_type = ICE_RESET_EMPR; 674 /* return if no valid reset type requested */ 675 if (reset_type == ICE_RESET_INVAL) 676 return; 677 ice_prepare_for_reset(pf, reset_type); 678 679 /* make sure we are ready to rebuild */ 680 if (ice_check_reset(&pf->hw)) { 681 set_bit(ICE_RESET_FAILED, pf->state); 682 } else { 683 /* done with reset. start rebuild */ 684 pf->hw.reset_ongoing = false; 685 ice_rebuild(pf, reset_type); 686 /* clear bit to resume normal operations, but 687 * ICE_NEEDS_RESTART bit is set in case rebuild failed 688 */ 689 clear_bit(ICE_RESET_OICR_RECV, pf->state); 690 clear_bit(ICE_PREPARED_FOR_RESET, pf->state); 691 clear_bit(ICE_PFR_REQ, pf->state); 692 clear_bit(ICE_CORER_REQ, pf->state); 693 clear_bit(ICE_GLOBR_REQ, pf->state); 694 wake_up(&pf->reset_wait_queue); 695 ice_reset_all_vfs(pf); 696 } 697 698 return; 699 } 700 701 /* No pending resets to finish processing. Check for new resets */ 702 if (test_bit(ICE_PFR_REQ, pf->state)) 703 reset_type = ICE_RESET_PFR; 704 if (test_bit(ICE_CORER_REQ, pf->state)) 705 reset_type = ICE_RESET_CORER; 706 if (test_bit(ICE_GLOBR_REQ, pf->state)) 707 reset_type = ICE_RESET_GLOBR; 708 /* If no valid reset type requested just return */ 709 if (reset_type == ICE_RESET_INVAL) 710 return; 711 712 /* reset if not already down or busy */ 713 if (!test_bit(ICE_DOWN, pf->state) && 714 !test_bit(ICE_CFG_BUSY, pf->state)) { 715 ice_do_reset(pf, reset_type); 716 } 717 } 718 719 /** 720 * ice_print_topo_conflict - print topology conflict message 721 * @vsi: the VSI whose topology status is being checked 722 */ 723 static void ice_print_topo_conflict(struct ice_vsi *vsi) 724 { 725 switch (vsi->port_info->phy.link_info.topo_media_conflict) { 726 case ICE_AQ_LINK_TOPO_CONFLICT: 727 case ICE_AQ_LINK_MEDIA_CONFLICT: 728 case ICE_AQ_LINK_TOPO_UNREACH_PRT: 729 case ICE_AQ_LINK_TOPO_UNDRUTIL_PRT: 730 case ICE_AQ_LINK_TOPO_UNDRUTIL_MEDIA: 731 netdev_info(vsi->netdev, "Potential misconfiguration of the Ethernet port detected. If it was not intended, please use the Intel (R) Ethernet Port Configuration Tool to address the issue.\n"); 732 break; 733 case ICE_AQ_LINK_TOPO_UNSUPP_MEDIA: 734 if (test_bit(ICE_FLAG_LINK_LENIENT_MODE_ENA, vsi->back->flags)) 735 netdev_warn(vsi->netdev, "An unsupported module type was detected. Refer to the Intel(R) Ethernet Adapters and Devices User Guide for a list of supported modules\n"); 736 else 737 netdev_err(vsi->netdev, "Rx/Tx is disabled on this device because an unsupported module type was detected. Refer to the Intel(R) Ethernet Adapters and Devices User Guide for a list of supported modules.\n"); 738 break; 739 default: 740 break; 741 } 742 } 743 744 /** 745 * ice_print_link_msg - print link up or down message 746 * @vsi: the VSI whose link status is being queried 747 * @isup: boolean for if the link is now up or down 748 */ 749 void ice_print_link_msg(struct ice_vsi *vsi, bool isup) 750 { 751 struct ice_aqc_get_phy_caps_data *caps; 752 const char *an_advertised; 753 const char *fec_req; 754 const char *speed; 755 const char *fec; 756 const char *fc; 757 const char *an; 758 int status; 759 760 if (!vsi) 761 return; 762 763 if (vsi->current_isup == isup) 764 return; 765 766 vsi->current_isup = isup; 767 768 if (!isup) { 769 netdev_info(vsi->netdev, "NIC Link is Down\n"); 770 return; 771 } 772 773 switch (vsi->port_info->phy.link_info.link_speed) { 774 case ICE_AQ_LINK_SPEED_100GB: 775 speed = "100 G"; 776 break; 777 case ICE_AQ_LINK_SPEED_50GB: 778 speed = "50 G"; 779 break; 780 case ICE_AQ_LINK_SPEED_40GB: 781 speed = "40 G"; 782 break; 783 case ICE_AQ_LINK_SPEED_25GB: 784 speed = "25 G"; 785 break; 786 case ICE_AQ_LINK_SPEED_20GB: 787 speed = "20 G"; 788 break; 789 case ICE_AQ_LINK_SPEED_10GB: 790 speed = "10 G"; 791 break; 792 case ICE_AQ_LINK_SPEED_5GB: 793 speed = "5 G"; 794 break; 795 case ICE_AQ_LINK_SPEED_2500MB: 796 speed = "2.5 G"; 797 break; 798 case ICE_AQ_LINK_SPEED_1000MB: 799 speed = "1 G"; 800 break; 801 case ICE_AQ_LINK_SPEED_100MB: 802 speed = "100 M"; 803 break; 804 default: 805 speed = "Unknown "; 806 break; 807 } 808 809 switch (vsi->port_info->fc.current_mode) { 810 case ICE_FC_FULL: 811 fc = "Rx/Tx"; 812 break; 813 case ICE_FC_TX_PAUSE: 814 fc = "Tx"; 815 break; 816 case ICE_FC_RX_PAUSE: 817 fc = "Rx"; 818 break; 819 case ICE_FC_NONE: 820 fc = "None"; 821 break; 822 default: 823 fc = "Unknown"; 824 break; 825 } 826 827 /* Get FEC mode based on negotiated link info */ 828 switch (vsi->port_info->phy.link_info.fec_info) { 829 case ICE_AQ_LINK_25G_RS_528_FEC_EN: 830 case ICE_AQ_LINK_25G_RS_544_FEC_EN: 831 fec = "RS-FEC"; 832 break; 833 case ICE_AQ_LINK_25G_KR_FEC_EN: 834 fec = "FC-FEC/BASE-R"; 835 break; 836 default: 837 fec = "NONE"; 838 break; 839 } 840 841 /* check if autoneg completed, might be false due to not supported */ 842 if (vsi->port_info->phy.link_info.an_info & ICE_AQ_AN_COMPLETED) 843 an = "True"; 844 else 845 an = "False"; 846 847 /* Get FEC mode requested based on PHY caps last SW configuration */ 848 caps = kzalloc(sizeof(*caps), GFP_KERNEL); 849 if (!caps) { 850 fec_req = "Unknown"; 851 an_advertised = "Unknown"; 852 goto done; 853 } 854 855 status = ice_aq_get_phy_caps(vsi->port_info, false, 856 ICE_AQC_REPORT_ACTIVE_CFG, caps, NULL); 857 if (status) 858 netdev_info(vsi->netdev, "Get phy capability failed.\n"); 859 860 an_advertised = ice_is_phy_caps_an_enabled(caps) ? "On" : "Off"; 861 862 if (caps->link_fec_options & ICE_AQC_PHY_FEC_25G_RS_528_REQ || 863 caps->link_fec_options & ICE_AQC_PHY_FEC_25G_RS_544_REQ) 864 fec_req = "RS-FEC"; 865 else if (caps->link_fec_options & ICE_AQC_PHY_FEC_10G_KR_40G_KR4_REQ || 866 caps->link_fec_options & ICE_AQC_PHY_FEC_25G_KR_REQ) 867 fec_req = "FC-FEC/BASE-R"; 868 else 869 fec_req = "NONE"; 870 871 kfree(caps); 872 873 done: 874 netdev_info(vsi->netdev, "NIC Link is up %sbps Full Duplex, Requested FEC: %s, Negotiated FEC: %s, Autoneg Advertised: %s, Autoneg Negotiated: %s, Flow Control: %s\n", 875 speed, fec_req, fec, an_advertised, an, fc); 876 ice_print_topo_conflict(vsi); 877 } 878 879 /** 880 * ice_vsi_link_event - update the VSI's netdev 881 * @vsi: the VSI on which the link event occurred 882 * @link_up: whether or not the VSI needs to be set up or down 883 */ 884 static void ice_vsi_link_event(struct ice_vsi *vsi, bool link_up) 885 { 886 if (!vsi) 887 return; 888 889 if (test_bit(ICE_VSI_DOWN, vsi->state) || !vsi->netdev) 890 return; 891 892 if (vsi->type == ICE_VSI_PF) { 893 if (link_up == netif_carrier_ok(vsi->netdev)) 894 return; 895 896 if (link_up) { 897 netif_carrier_on(vsi->netdev); 898 netif_tx_wake_all_queues(vsi->netdev); 899 } else { 900 netif_carrier_off(vsi->netdev); 901 netif_tx_stop_all_queues(vsi->netdev); 902 } 903 } 904 } 905 906 /** 907 * ice_set_dflt_mib - send a default config MIB to the FW 908 * @pf: private PF struct 909 * 910 * This function sends a default configuration MIB to the FW. 911 * 912 * If this function errors out at any point, the driver is still able to 913 * function. The main impact is that LFC may not operate as expected. 914 * Therefore an error state in this function should be treated with a DBG 915 * message and continue on with driver rebuild/reenable. 916 */ 917 static void ice_set_dflt_mib(struct ice_pf *pf) 918 { 919 struct device *dev = ice_pf_to_dev(pf); 920 u8 mib_type, *buf, *lldpmib = NULL; 921 u16 len, typelen, offset = 0; 922 struct ice_lldp_org_tlv *tlv; 923 struct ice_hw *hw = &pf->hw; 924 u32 ouisubtype; 925 926 mib_type = SET_LOCAL_MIB_TYPE_LOCAL_MIB; 927 lldpmib = kzalloc(ICE_LLDPDU_SIZE, GFP_KERNEL); 928 if (!lldpmib) { 929 dev_dbg(dev, "%s Failed to allocate MIB memory\n", 930 __func__); 931 return; 932 } 933 934 /* Add ETS CFG TLV */ 935 tlv = (struct ice_lldp_org_tlv *)lldpmib; 936 typelen = ((ICE_TLV_TYPE_ORG << ICE_LLDP_TLV_TYPE_S) | 937 ICE_IEEE_ETS_TLV_LEN); 938 tlv->typelen = htons(typelen); 939 ouisubtype = ((ICE_IEEE_8021QAZ_OUI << ICE_LLDP_TLV_OUI_S) | 940 ICE_IEEE_SUBTYPE_ETS_CFG); 941 tlv->ouisubtype = htonl(ouisubtype); 942 943 buf = tlv->tlvinfo; 944 buf[0] = 0; 945 946 /* ETS CFG all UPs map to TC 0. Next 4 (1 - 4) Octets = 0. 947 * Octets 5 - 12 are BW values, set octet 5 to 100% BW. 948 * Octets 13 - 20 are TSA values - leave as zeros 949 */ 950 buf[5] = 0x64; 951 len = (typelen & ICE_LLDP_TLV_LEN_M) >> ICE_LLDP_TLV_LEN_S; 952 offset += len + 2; 953 tlv = (struct ice_lldp_org_tlv *) 954 ((char *)tlv + sizeof(tlv->typelen) + len); 955 956 /* Add ETS REC TLV */ 957 buf = tlv->tlvinfo; 958 tlv->typelen = htons(typelen); 959 960 ouisubtype = ((ICE_IEEE_8021QAZ_OUI << ICE_LLDP_TLV_OUI_S) | 961 ICE_IEEE_SUBTYPE_ETS_REC); 962 tlv->ouisubtype = htonl(ouisubtype); 963 964 /* First octet of buf is reserved 965 * Octets 1 - 4 map UP to TC - all UPs map to zero 966 * Octets 5 - 12 are BW values - set TC 0 to 100%. 967 * Octets 13 - 20 are TSA value - leave as zeros 968 */ 969 buf[5] = 0x64; 970 offset += len + 2; 971 tlv = (struct ice_lldp_org_tlv *) 972 ((char *)tlv + sizeof(tlv->typelen) + len); 973 974 /* Add PFC CFG TLV */ 975 typelen = ((ICE_TLV_TYPE_ORG << ICE_LLDP_TLV_TYPE_S) | 976 ICE_IEEE_PFC_TLV_LEN); 977 tlv->typelen = htons(typelen); 978 979 ouisubtype = ((ICE_IEEE_8021QAZ_OUI << ICE_LLDP_TLV_OUI_S) | 980 ICE_IEEE_SUBTYPE_PFC_CFG); 981 tlv->ouisubtype = htonl(ouisubtype); 982 983 /* Octet 1 left as all zeros - PFC disabled */ 984 buf[0] = 0x08; 985 len = (typelen & ICE_LLDP_TLV_LEN_M) >> ICE_LLDP_TLV_LEN_S; 986 offset += len + 2; 987 988 if (ice_aq_set_lldp_mib(hw, mib_type, (void *)lldpmib, offset, NULL)) 989 dev_dbg(dev, "%s Failed to set default LLDP MIB\n", __func__); 990 991 kfree(lldpmib); 992 } 993 994 /** 995 * ice_check_phy_fw_load - check if PHY FW load failed 996 * @pf: pointer to PF struct 997 * @link_cfg_err: bitmap from the link info structure 998 * 999 * check if external PHY FW load failed and print an error message if it did 1000 */ 1001 static void ice_check_phy_fw_load(struct ice_pf *pf, u8 link_cfg_err) 1002 { 1003 if (!(link_cfg_err & ICE_AQ_LINK_EXTERNAL_PHY_LOAD_FAILURE)) { 1004 clear_bit(ICE_FLAG_PHY_FW_LOAD_FAILED, pf->flags); 1005 return; 1006 } 1007 1008 if (test_bit(ICE_FLAG_PHY_FW_LOAD_FAILED, pf->flags)) 1009 return; 1010 1011 if (link_cfg_err & ICE_AQ_LINK_EXTERNAL_PHY_LOAD_FAILURE) { 1012 dev_err(ice_pf_to_dev(pf), "Device failed to load the FW for the external PHY. Please download and install the latest NVM for your device and try again\n"); 1013 set_bit(ICE_FLAG_PHY_FW_LOAD_FAILED, pf->flags); 1014 } 1015 } 1016 1017 /** 1018 * ice_check_module_power 1019 * @pf: pointer to PF struct 1020 * @link_cfg_err: bitmap from the link info structure 1021 * 1022 * check module power level returned by a previous call to aq_get_link_info 1023 * and print error messages if module power level is not supported 1024 */ 1025 static void ice_check_module_power(struct ice_pf *pf, u8 link_cfg_err) 1026 { 1027 /* if module power level is supported, clear the flag */ 1028 if (!(link_cfg_err & (ICE_AQ_LINK_INVAL_MAX_POWER_LIMIT | 1029 ICE_AQ_LINK_MODULE_POWER_UNSUPPORTED))) { 1030 clear_bit(ICE_FLAG_MOD_POWER_UNSUPPORTED, pf->flags); 1031 return; 1032 } 1033 1034 /* if ICE_FLAG_MOD_POWER_UNSUPPORTED was previously set and the 1035 * above block didn't clear this bit, there's nothing to do 1036 */ 1037 if (test_bit(ICE_FLAG_MOD_POWER_UNSUPPORTED, pf->flags)) 1038 return; 1039 1040 if (link_cfg_err & ICE_AQ_LINK_INVAL_MAX_POWER_LIMIT) { 1041 dev_err(ice_pf_to_dev(pf), "The installed module is incompatible with the device's NVM image. Cannot start link\n"); 1042 set_bit(ICE_FLAG_MOD_POWER_UNSUPPORTED, pf->flags); 1043 } else if (link_cfg_err & ICE_AQ_LINK_MODULE_POWER_UNSUPPORTED) { 1044 dev_err(ice_pf_to_dev(pf), "The module's power requirements exceed the device's power supply. Cannot start link\n"); 1045 set_bit(ICE_FLAG_MOD_POWER_UNSUPPORTED, pf->flags); 1046 } 1047 } 1048 1049 /** 1050 * ice_check_link_cfg_err - check if link configuration failed 1051 * @pf: pointer to the PF struct 1052 * @link_cfg_err: bitmap from the link info structure 1053 * 1054 * print if any link configuration failure happens due to the value in the 1055 * link_cfg_err parameter in the link info structure 1056 */ 1057 static void ice_check_link_cfg_err(struct ice_pf *pf, u8 link_cfg_err) 1058 { 1059 ice_check_module_power(pf, link_cfg_err); 1060 ice_check_phy_fw_load(pf, link_cfg_err); 1061 } 1062 1063 /** 1064 * ice_link_event - process the link event 1065 * @pf: PF that the link event is associated with 1066 * @pi: port_info for the port that the link event is associated with 1067 * @link_up: true if the physical link is up and false if it is down 1068 * @link_speed: current link speed received from the link event 1069 * 1070 * Returns 0 on success and negative on failure 1071 */ 1072 static int 1073 ice_link_event(struct ice_pf *pf, struct ice_port_info *pi, bool link_up, 1074 u16 link_speed) 1075 { 1076 struct device *dev = ice_pf_to_dev(pf); 1077 struct ice_phy_info *phy_info; 1078 struct ice_vsi *vsi; 1079 u16 old_link_speed; 1080 bool old_link; 1081 int status; 1082 1083 phy_info = &pi->phy; 1084 phy_info->link_info_old = phy_info->link_info; 1085 1086 old_link = !!(phy_info->link_info_old.link_info & ICE_AQ_LINK_UP); 1087 old_link_speed = phy_info->link_info_old.link_speed; 1088 1089 /* update the link info structures and re-enable link events, 1090 * don't bail on failure due to other book keeping needed 1091 */ 1092 status = ice_update_link_info(pi); 1093 if (status) 1094 dev_dbg(dev, "Failed to update link status on port %d, err %d aq_err %s\n", 1095 pi->lport, status, 1096 ice_aq_str(pi->hw->adminq.sq_last_status)); 1097 1098 ice_check_link_cfg_err(pf, pi->phy.link_info.link_cfg_err); 1099 1100 /* Check if the link state is up after updating link info, and treat 1101 * this event as an UP event since the link is actually UP now. 1102 */ 1103 if (phy_info->link_info.link_info & ICE_AQ_LINK_UP) 1104 link_up = true; 1105 1106 vsi = ice_get_main_vsi(pf); 1107 if (!vsi || !vsi->port_info) 1108 return -EINVAL; 1109 1110 /* turn off PHY if media was removed */ 1111 if (!test_bit(ICE_FLAG_NO_MEDIA, pf->flags) && 1112 !(pi->phy.link_info.link_info & ICE_AQ_MEDIA_AVAILABLE)) { 1113 set_bit(ICE_FLAG_NO_MEDIA, pf->flags); 1114 ice_set_link(vsi, false); 1115 } 1116 1117 /* if the old link up/down and speed is the same as the new */ 1118 if (link_up == old_link && link_speed == old_link_speed) 1119 return 0; 1120 1121 if (!ice_is_e810(&pf->hw)) 1122 ice_ptp_link_change(pf, pf->hw.pf_id, link_up); 1123 1124 if (ice_is_dcb_active(pf)) { 1125 if (test_bit(ICE_FLAG_DCB_ENA, pf->flags)) 1126 ice_dcb_rebuild(pf); 1127 } else { 1128 if (link_up) 1129 ice_set_dflt_mib(pf); 1130 } 1131 ice_vsi_link_event(vsi, link_up); 1132 ice_print_link_msg(vsi, link_up); 1133 1134 ice_vc_notify_link_state(pf); 1135 1136 return 0; 1137 } 1138 1139 /** 1140 * ice_watchdog_subtask - periodic tasks not using event driven scheduling 1141 * @pf: board private structure 1142 */ 1143 static void ice_watchdog_subtask(struct ice_pf *pf) 1144 { 1145 int i; 1146 1147 /* if interface is down do nothing */ 1148 if (test_bit(ICE_DOWN, pf->state) || 1149 test_bit(ICE_CFG_BUSY, pf->state)) 1150 return; 1151 1152 /* make sure we don't do these things too often */ 1153 if (time_before(jiffies, 1154 pf->serv_tmr_prev + pf->serv_tmr_period)) 1155 return; 1156 1157 pf->serv_tmr_prev = jiffies; 1158 1159 /* Update the stats for active netdevs so the network stack 1160 * can look at updated numbers whenever it cares to 1161 */ 1162 ice_update_pf_stats(pf); 1163 ice_for_each_vsi(pf, i) 1164 if (pf->vsi[i] && pf->vsi[i]->netdev) 1165 ice_update_vsi_stats(pf->vsi[i]); 1166 } 1167 1168 /** 1169 * ice_init_link_events - enable/initialize link events 1170 * @pi: pointer to the port_info instance 1171 * 1172 * Returns -EIO on failure, 0 on success 1173 */ 1174 static int ice_init_link_events(struct ice_port_info *pi) 1175 { 1176 u16 mask; 1177 1178 mask = ~((u16)(ICE_AQ_LINK_EVENT_UPDOWN | ICE_AQ_LINK_EVENT_MEDIA_NA | 1179 ICE_AQ_LINK_EVENT_MODULE_QUAL_FAIL | 1180 ICE_AQ_LINK_EVENT_PHY_FW_LOAD_FAIL)); 1181 1182 if (ice_aq_set_event_mask(pi->hw, pi->lport, mask, NULL)) { 1183 dev_dbg(ice_hw_to_dev(pi->hw), "Failed to set link event mask for port %d\n", 1184 pi->lport); 1185 return -EIO; 1186 } 1187 1188 if (ice_aq_get_link_info(pi, true, NULL, NULL)) { 1189 dev_dbg(ice_hw_to_dev(pi->hw), "Failed to enable link events for port %d\n", 1190 pi->lport); 1191 return -EIO; 1192 } 1193 1194 return 0; 1195 } 1196 1197 /** 1198 * ice_handle_link_event - handle link event via ARQ 1199 * @pf: PF that the link event is associated with 1200 * @event: event structure containing link status info 1201 */ 1202 static int 1203 ice_handle_link_event(struct ice_pf *pf, struct ice_rq_event_info *event) 1204 { 1205 struct ice_aqc_get_link_status_data *link_data; 1206 struct ice_port_info *port_info; 1207 int status; 1208 1209 link_data = (struct ice_aqc_get_link_status_data *)event->msg_buf; 1210 port_info = pf->hw.port_info; 1211 if (!port_info) 1212 return -EINVAL; 1213 1214 status = ice_link_event(pf, port_info, 1215 !!(link_data->link_info & ICE_AQ_LINK_UP), 1216 le16_to_cpu(link_data->link_speed)); 1217 if (status) 1218 dev_dbg(ice_pf_to_dev(pf), "Could not process link event, error %d\n", 1219 status); 1220 1221 return status; 1222 } 1223 1224 enum ice_aq_task_state { 1225 ICE_AQ_TASK_WAITING = 0, 1226 ICE_AQ_TASK_COMPLETE, 1227 ICE_AQ_TASK_CANCELED, 1228 }; 1229 1230 struct ice_aq_task { 1231 struct hlist_node entry; 1232 1233 u16 opcode; 1234 struct ice_rq_event_info *event; 1235 enum ice_aq_task_state state; 1236 }; 1237 1238 /** 1239 * ice_aq_wait_for_event - Wait for an AdminQ event from firmware 1240 * @pf: pointer to the PF private structure 1241 * @opcode: the opcode to wait for 1242 * @timeout: how long to wait, in jiffies 1243 * @event: storage for the event info 1244 * 1245 * Waits for a specific AdminQ completion event on the ARQ for a given PF. The 1246 * current thread will be put to sleep until the specified event occurs or 1247 * until the given timeout is reached. 1248 * 1249 * To obtain only the descriptor contents, pass an event without an allocated 1250 * msg_buf. If the complete data buffer is desired, allocate the 1251 * event->msg_buf with enough space ahead of time. 1252 * 1253 * Returns: zero on success, or a negative error code on failure. 1254 */ 1255 int ice_aq_wait_for_event(struct ice_pf *pf, u16 opcode, unsigned long timeout, 1256 struct ice_rq_event_info *event) 1257 { 1258 struct device *dev = ice_pf_to_dev(pf); 1259 struct ice_aq_task *task; 1260 unsigned long start; 1261 long ret; 1262 int err; 1263 1264 task = kzalloc(sizeof(*task), GFP_KERNEL); 1265 if (!task) 1266 return -ENOMEM; 1267 1268 INIT_HLIST_NODE(&task->entry); 1269 task->opcode = opcode; 1270 task->event = event; 1271 task->state = ICE_AQ_TASK_WAITING; 1272 1273 spin_lock_bh(&pf->aq_wait_lock); 1274 hlist_add_head(&task->entry, &pf->aq_wait_list); 1275 spin_unlock_bh(&pf->aq_wait_lock); 1276 1277 start = jiffies; 1278 1279 ret = wait_event_interruptible_timeout(pf->aq_wait_queue, task->state, 1280 timeout); 1281 switch (task->state) { 1282 case ICE_AQ_TASK_WAITING: 1283 err = ret < 0 ? ret : -ETIMEDOUT; 1284 break; 1285 case ICE_AQ_TASK_CANCELED: 1286 err = ret < 0 ? ret : -ECANCELED; 1287 break; 1288 case ICE_AQ_TASK_COMPLETE: 1289 err = ret < 0 ? ret : 0; 1290 break; 1291 default: 1292 WARN(1, "Unexpected AdminQ wait task state %u", task->state); 1293 err = -EINVAL; 1294 break; 1295 } 1296 1297 dev_dbg(dev, "Waited %u msecs (max %u msecs) for firmware response to op 0x%04x\n", 1298 jiffies_to_msecs(jiffies - start), 1299 jiffies_to_msecs(timeout), 1300 opcode); 1301 1302 spin_lock_bh(&pf->aq_wait_lock); 1303 hlist_del(&task->entry); 1304 spin_unlock_bh(&pf->aq_wait_lock); 1305 kfree(task); 1306 1307 return err; 1308 } 1309 1310 /** 1311 * ice_aq_check_events - Check if any thread is waiting for an AdminQ event 1312 * @pf: pointer to the PF private structure 1313 * @opcode: the opcode of the event 1314 * @event: the event to check 1315 * 1316 * Loops over the current list of pending threads waiting for an AdminQ event. 1317 * For each matching task, copy the contents of the event into the task 1318 * structure and wake up the thread. 1319 * 1320 * If multiple threads wait for the same opcode, they will all be woken up. 1321 * 1322 * Note that event->msg_buf will only be duplicated if the event has a buffer 1323 * with enough space already allocated. Otherwise, only the descriptor and 1324 * message length will be copied. 1325 * 1326 * Returns: true if an event was found, false otherwise 1327 */ 1328 static void ice_aq_check_events(struct ice_pf *pf, u16 opcode, 1329 struct ice_rq_event_info *event) 1330 { 1331 struct ice_aq_task *task; 1332 bool found = false; 1333 1334 spin_lock_bh(&pf->aq_wait_lock); 1335 hlist_for_each_entry(task, &pf->aq_wait_list, entry) { 1336 if (task->state || task->opcode != opcode) 1337 continue; 1338 1339 memcpy(&task->event->desc, &event->desc, sizeof(event->desc)); 1340 task->event->msg_len = event->msg_len; 1341 1342 /* Only copy the data buffer if a destination was set */ 1343 if (task->event->msg_buf && 1344 task->event->buf_len > event->buf_len) { 1345 memcpy(task->event->msg_buf, event->msg_buf, 1346 event->buf_len); 1347 task->event->buf_len = event->buf_len; 1348 } 1349 1350 task->state = ICE_AQ_TASK_COMPLETE; 1351 found = true; 1352 } 1353 spin_unlock_bh(&pf->aq_wait_lock); 1354 1355 if (found) 1356 wake_up(&pf->aq_wait_queue); 1357 } 1358 1359 /** 1360 * ice_aq_cancel_waiting_tasks - Immediately cancel all waiting tasks 1361 * @pf: the PF private structure 1362 * 1363 * Set all waiting tasks to ICE_AQ_TASK_CANCELED, and wake up their threads. 1364 * This will then cause ice_aq_wait_for_event to exit with -ECANCELED. 1365 */ 1366 static void ice_aq_cancel_waiting_tasks(struct ice_pf *pf) 1367 { 1368 struct ice_aq_task *task; 1369 1370 spin_lock_bh(&pf->aq_wait_lock); 1371 hlist_for_each_entry(task, &pf->aq_wait_list, entry) 1372 task->state = ICE_AQ_TASK_CANCELED; 1373 spin_unlock_bh(&pf->aq_wait_lock); 1374 1375 wake_up(&pf->aq_wait_queue); 1376 } 1377 1378 /** 1379 * __ice_clean_ctrlq - helper function to clean controlq rings 1380 * @pf: ptr to struct ice_pf 1381 * @q_type: specific Control queue type 1382 */ 1383 static int __ice_clean_ctrlq(struct ice_pf *pf, enum ice_ctl_q q_type) 1384 { 1385 struct device *dev = ice_pf_to_dev(pf); 1386 struct ice_rq_event_info event; 1387 struct ice_hw *hw = &pf->hw; 1388 struct ice_ctl_q_info *cq; 1389 u16 pending, i = 0; 1390 const char *qtype; 1391 u32 oldval, val; 1392 1393 /* Do not clean control queue if/when PF reset fails */ 1394 if (test_bit(ICE_RESET_FAILED, pf->state)) 1395 return 0; 1396 1397 switch (q_type) { 1398 case ICE_CTL_Q_ADMIN: 1399 cq = &hw->adminq; 1400 qtype = "Admin"; 1401 break; 1402 case ICE_CTL_Q_SB: 1403 cq = &hw->sbq; 1404 qtype = "Sideband"; 1405 break; 1406 case ICE_CTL_Q_MAILBOX: 1407 cq = &hw->mailboxq; 1408 qtype = "Mailbox"; 1409 /* we are going to try to detect a malicious VF, so set the 1410 * state to begin detection 1411 */ 1412 hw->mbx_snapshot.mbx_buf.state = ICE_MAL_VF_DETECT_STATE_NEW_SNAPSHOT; 1413 break; 1414 default: 1415 dev_warn(dev, "Unknown control queue type 0x%x\n", q_type); 1416 return 0; 1417 } 1418 1419 /* check for error indications - PF_xx_AxQLEN register layout for 1420 * FW/MBX/SB are identical so just use defines for PF_FW_AxQLEN. 1421 */ 1422 val = rd32(hw, cq->rq.len); 1423 if (val & (PF_FW_ARQLEN_ARQVFE_M | PF_FW_ARQLEN_ARQOVFL_M | 1424 PF_FW_ARQLEN_ARQCRIT_M)) { 1425 oldval = val; 1426 if (val & PF_FW_ARQLEN_ARQVFE_M) 1427 dev_dbg(dev, "%s Receive Queue VF Error detected\n", 1428 qtype); 1429 if (val & PF_FW_ARQLEN_ARQOVFL_M) { 1430 dev_dbg(dev, "%s Receive Queue Overflow Error detected\n", 1431 qtype); 1432 } 1433 if (val & PF_FW_ARQLEN_ARQCRIT_M) 1434 dev_dbg(dev, "%s Receive Queue Critical Error detected\n", 1435 qtype); 1436 val &= ~(PF_FW_ARQLEN_ARQVFE_M | PF_FW_ARQLEN_ARQOVFL_M | 1437 PF_FW_ARQLEN_ARQCRIT_M); 1438 if (oldval != val) 1439 wr32(hw, cq->rq.len, val); 1440 } 1441 1442 val = rd32(hw, cq->sq.len); 1443 if (val & (PF_FW_ATQLEN_ATQVFE_M | PF_FW_ATQLEN_ATQOVFL_M | 1444 PF_FW_ATQLEN_ATQCRIT_M)) { 1445 oldval = val; 1446 if (val & PF_FW_ATQLEN_ATQVFE_M) 1447 dev_dbg(dev, "%s Send Queue VF Error detected\n", 1448 qtype); 1449 if (val & PF_FW_ATQLEN_ATQOVFL_M) { 1450 dev_dbg(dev, "%s Send Queue Overflow Error detected\n", 1451 qtype); 1452 } 1453 if (val & PF_FW_ATQLEN_ATQCRIT_M) 1454 dev_dbg(dev, "%s Send Queue Critical Error detected\n", 1455 qtype); 1456 val &= ~(PF_FW_ATQLEN_ATQVFE_M | PF_FW_ATQLEN_ATQOVFL_M | 1457 PF_FW_ATQLEN_ATQCRIT_M); 1458 if (oldval != val) 1459 wr32(hw, cq->sq.len, val); 1460 } 1461 1462 event.buf_len = cq->rq_buf_size; 1463 event.msg_buf = kzalloc(event.buf_len, GFP_KERNEL); 1464 if (!event.msg_buf) 1465 return 0; 1466 1467 do { 1468 u16 opcode; 1469 int ret; 1470 1471 ret = ice_clean_rq_elem(hw, cq, &event, &pending); 1472 if (ret == -EALREADY) 1473 break; 1474 if (ret) { 1475 dev_err(dev, "%s Receive Queue event error %d\n", qtype, 1476 ret); 1477 break; 1478 } 1479 1480 opcode = le16_to_cpu(event.desc.opcode); 1481 1482 /* Notify any thread that might be waiting for this event */ 1483 ice_aq_check_events(pf, opcode, &event); 1484 1485 switch (opcode) { 1486 case ice_aqc_opc_get_link_status: 1487 if (ice_handle_link_event(pf, &event)) 1488 dev_err(dev, "Could not handle link event\n"); 1489 break; 1490 case ice_aqc_opc_event_lan_overflow: 1491 ice_vf_lan_overflow_event(pf, &event); 1492 break; 1493 case ice_mbx_opc_send_msg_to_pf: 1494 if (!ice_is_malicious_vf(pf, &event, i, pending)) 1495 ice_vc_process_vf_msg(pf, &event); 1496 break; 1497 case ice_aqc_opc_fw_logging: 1498 ice_output_fw_log(hw, &event.desc, event.msg_buf); 1499 break; 1500 case ice_aqc_opc_lldp_set_mib_change: 1501 ice_dcb_process_lldp_set_mib_change(pf, &event); 1502 break; 1503 default: 1504 dev_dbg(dev, "%s Receive Queue unknown event 0x%04x ignored\n", 1505 qtype, opcode); 1506 break; 1507 } 1508 } while (pending && (i++ < ICE_DFLT_IRQ_WORK)); 1509 1510 kfree(event.msg_buf); 1511 1512 return pending && (i == ICE_DFLT_IRQ_WORK); 1513 } 1514 1515 /** 1516 * ice_ctrlq_pending - check if there is a difference between ntc and ntu 1517 * @hw: pointer to hardware info 1518 * @cq: control queue information 1519 * 1520 * returns true if there are pending messages in a queue, false if there aren't 1521 */ 1522 static bool ice_ctrlq_pending(struct ice_hw *hw, struct ice_ctl_q_info *cq) 1523 { 1524 u16 ntu; 1525 1526 ntu = (u16)(rd32(hw, cq->rq.head) & cq->rq.head_mask); 1527 return cq->rq.next_to_clean != ntu; 1528 } 1529 1530 /** 1531 * ice_clean_adminq_subtask - clean the AdminQ rings 1532 * @pf: board private structure 1533 */ 1534 static void ice_clean_adminq_subtask(struct ice_pf *pf) 1535 { 1536 struct ice_hw *hw = &pf->hw; 1537 1538 if (!test_bit(ICE_ADMINQ_EVENT_PENDING, pf->state)) 1539 return; 1540 1541 if (__ice_clean_ctrlq(pf, ICE_CTL_Q_ADMIN)) 1542 return; 1543 1544 clear_bit(ICE_ADMINQ_EVENT_PENDING, pf->state); 1545 1546 /* There might be a situation where new messages arrive to a control 1547 * queue between processing the last message and clearing the 1548 * EVENT_PENDING bit. So before exiting, check queue head again (using 1549 * ice_ctrlq_pending) and process new messages if any. 1550 */ 1551 if (ice_ctrlq_pending(hw, &hw->adminq)) 1552 __ice_clean_ctrlq(pf, ICE_CTL_Q_ADMIN); 1553 1554 ice_flush(hw); 1555 } 1556 1557 /** 1558 * ice_clean_mailboxq_subtask - clean the MailboxQ rings 1559 * @pf: board private structure 1560 */ 1561 static void ice_clean_mailboxq_subtask(struct ice_pf *pf) 1562 { 1563 struct ice_hw *hw = &pf->hw; 1564 1565 if (!test_bit(ICE_MAILBOXQ_EVENT_PENDING, pf->state)) 1566 return; 1567 1568 if (__ice_clean_ctrlq(pf, ICE_CTL_Q_MAILBOX)) 1569 return; 1570 1571 clear_bit(ICE_MAILBOXQ_EVENT_PENDING, pf->state); 1572 1573 if (ice_ctrlq_pending(hw, &hw->mailboxq)) 1574 __ice_clean_ctrlq(pf, ICE_CTL_Q_MAILBOX); 1575 1576 ice_flush(hw); 1577 } 1578 1579 /** 1580 * ice_clean_sbq_subtask - clean the Sideband Queue rings 1581 * @pf: board private structure 1582 */ 1583 static void ice_clean_sbq_subtask(struct ice_pf *pf) 1584 { 1585 struct ice_hw *hw = &pf->hw; 1586 1587 /* Nothing to do here if sideband queue is not supported */ 1588 if (!ice_is_sbq_supported(hw)) { 1589 clear_bit(ICE_SIDEBANDQ_EVENT_PENDING, pf->state); 1590 return; 1591 } 1592 1593 if (!test_bit(ICE_SIDEBANDQ_EVENT_PENDING, pf->state)) 1594 return; 1595 1596 if (__ice_clean_ctrlq(pf, ICE_CTL_Q_SB)) 1597 return; 1598 1599 clear_bit(ICE_SIDEBANDQ_EVENT_PENDING, pf->state); 1600 1601 if (ice_ctrlq_pending(hw, &hw->sbq)) 1602 __ice_clean_ctrlq(pf, ICE_CTL_Q_SB); 1603 1604 ice_flush(hw); 1605 } 1606 1607 /** 1608 * ice_service_task_schedule - schedule the service task to wake up 1609 * @pf: board private structure 1610 * 1611 * If not already scheduled, this puts the task into the work queue. 1612 */ 1613 void ice_service_task_schedule(struct ice_pf *pf) 1614 { 1615 if (!test_bit(ICE_SERVICE_DIS, pf->state) && 1616 !test_and_set_bit(ICE_SERVICE_SCHED, pf->state) && 1617 !test_bit(ICE_NEEDS_RESTART, pf->state)) 1618 queue_work(ice_wq, &pf->serv_task); 1619 } 1620 1621 /** 1622 * ice_service_task_complete - finish up the service task 1623 * @pf: board private structure 1624 */ 1625 static void ice_service_task_complete(struct ice_pf *pf) 1626 { 1627 WARN_ON(!test_bit(ICE_SERVICE_SCHED, pf->state)); 1628 1629 /* force memory (pf->state) to sync before next service task */ 1630 smp_mb__before_atomic(); 1631 clear_bit(ICE_SERVICE_SCHED, pf->state); 1632 } 1633 1634 /** 1635 * ice_service_task_stop - stop service task and cancel works 1636 * @pf: board private structure 1637 * 1638 * Return 0 if the ICE_SERVICE_DIS bit was not already set, 1639 * 1 otherwise. 1640 */ 1641 static int ice_service_task_stop(struct ice_pf *pf) 1642 { 1643 int ret; 1644 1645 ret = test_and_set_bit(ICE_SERVICE_DIS, pf->state); 1646 1647 if (pf->serv_tmr.function) 1648 del_timer_sync(&pf->serv_tmr); 1649 if (pf->serv_task.func) 1650 cancel_work_sync(&pf->serv_task); 1651 1652 clear_bit(ICE_SERVICE_SCHED, pf->state); 1653 return ret; 1654 } 1655 1656 /** 1657 * ice_service_task_restart - restart service task and schedule works 1658 * @pf: board private structure 1659 * 1660 * This function is needed for suspend and resume works (e.g WoL scenario) 1661 */ 1662 static void ice_service_task_restart(struct ice_pf *pf) 1663 { 1664 clear_bit(ICE_SERVICE_DIS, pf->state); 1665 ice_service_task_schedule(pf); 1666 } 1667 1668 /** 1669 * ice_service_timer - timer callback to schedule service task 1670 * @t: pointer to timer_list 1671 */ 1672 static void ice_service_timer(struct timer_list *t) 1673 { 1674 struct ice_pf *pf = from_timer(pf, t, serv_tmr); 1675 1676 mod_timer(&pf->serv_tmr, round_jiffies(pf->serv_tmr_period + jiffies)); 1677 ice_service_task_schedule(pf); 1678 } 1679 1680 /** 1681 * ice_handle_mdd_event - handle malicious driver detect event 1682 * @pf: pointer to the PF structure 1683 * 1684 * Called from service task. OICR interrupt handler indicates MDD event. 1685 * VF MDD logging is guarded by net_ratelimit. Additional PF and VF log 1686 * messages are wrapped by netif_msg_[rx|tx]_err. Since VF Rx MDD events 1687 * disable the queue, the PF can be configured to reset the VF using ethtool 1688 * private flag mdd-auto-reset-vf. 1689 */ 1690 static void ice_handle_mdd_event(struct ice_pf *pf) 1691 { 1692 struct device *dev = ice_pf_to_dev(pf); 1693 struct ice_hw *hw = &pf->hw; 1694 struct ice_vf *vf; 1695 unsigned int bkt; 1696 u32 reg; 1697 1698 if (!test_and_clear_bit(ICE_MDD_EVENT_PENDING, pf->state)) { 1699 /* Since the VF MDD event logging is rate limited, check if 1700 * there are pending MDD events. 1701 */ 1702 ice_print_vfs_mdd_events(pf); 1703 return; 1704 } 1705 1706 /* find what triggered an MDD event */ 1707 reg = rd32(hw, GL_MDET_TX_PQM); 1708 if (reg & GL_MDET_TX_PQM_VALID_M) { 1709 u8 pf_num = (reg & GL_MDET_TX_PQM_PF_NUM_M) >> 1710 GL_MDET_TX_PQM_PF_NUM_S; 1711 u16 vf_num = (reg & GL_MDET_TX_PQM_VF_NUM_M) >> 1712 GL_MDET_TX_PQM_VF_NUM_S; 1713 u8 event = (reg & GL_MDET_TX_PQM_MAL_TYPE_M) >> 1714 GL_MDET_TX_PQM_MAL_TYPE_S; 1715 u16 queue = ((reg & GL_MDET_TX_PQM_QNUM_M) >> 1716 GL_MDET_TX_PQM_QNUM_S); 1717 1718 if (netif_msg_tx_err(pf)) 1719 dev_info(dev, "Malicious Driver Detection event %d on TX queue %d PF# %d VF# %d\n", 1720 event, queue, pf_num, vf_num); 1721 wr32(hw, GL_MDET_TX_PQM, 0xffffffff); 1722 } 1723 1724 reg = rd32(hw, GL_MDET_TX_TCLAN); 1725 if (reg & GL_MDET_TX_TCLAN_VALID_M) { 1726 u8 pf_num = (reg & GL_MDET_TX_TCLAN_PF_NUM_M) >> 1727 GL_MDET_TX_TCLAN_PF_NUM_S; 1728 u16 vf_num = (reg & GL_MDET_TX_TCLAN_VF_NUM_M) >> 1729 GL_MDET_TX_TCLAN_VF_NUM_S; 1730 u8 event = (reg & GL_MDET_TX_TCLAN_MAL_TYPE_M) >> 1731 GL_MDET_TX_TCLAN_MAL_TYPE_S; 1732 u16 queue = ((reg & GL_MDET_TX_TCLAN_QNUM_M) >> 1733 GL_MDET_TX_TCLAN_QNUM_S); 1734 1735 if (netif_msg_tx_err(pf)) 1736 dev_info(dev, "Malicious Driver Detection event %d on TX queue %d PF# %d VF# %d\n", 1737 event, queue, pf_num, vf_num); 1738 wr32(hw, GL_MDET_TX_TCLAN, 0xffffffff); 1739 } 1740 1741 reg = rd32(hw, GL_MDET_RX); 1742 if (reg & GL_MDET_RX_VALID_M) { 1743 u8 pf_num = (reg & GL_MDET_RX_PF_NUM_M) >> 1744 GL_MDET_RX_PF_NUM_S; 1745 u16 vf_num = (reg & GL_MDET_RX_VF_NUM_M) >> 1746 GL_MDET_RX_VF_NUM_S; 1747 u8 event = (reg & GL_MDET_RX_MAL_TYPE_M) >> 1748 GL_MDET_RX_MAL_TYPE_S; 1749 u16 queue = ((reg & GL_MDET_RX_QNUM_M) >> 1750 GL_MDET_RX_QNUM_S); 1751 1752 if (netif_msg_rx_err(pf)) 1753 dev_info(dev, "Malicious Driver Detection event %d on RX queue %d PF# %d VF# %d\n", 1754 event, queue, pf_num, vf_num); 1755 wr32(hw, GL_MDET_RX, 0xffffffff); 1756 } 1757 1758 /* check to see if this PF caused an MDD event */ 1759 reg = rd32(hw, PF_MDET_TX_PQM); 1760 if (reg & PF_MDET_TX_PQM_VALID_M) { 1761 wr32(hw, PF_MDET_TX_PQM, 0xFFFF); 1762 if (netif_msg_tx_err(pf)) 1763 dev_info(dev, "Malicious Driver Detection event TX_PQM detected on PF\n"); 1764 } 1765 1766 reg = rd32(hw, PF_MDET_TX_TCLAN); 1767 if (reg & PF_MDET_TX_TCLAN_VALID_M) { 1768 wr32(hw, PF_MDET_TX_TCLAN, 0xFFFF); 1769 if (netif_msg_tx_err(pf)) 1770 dev_info(dev, "Malicious Driver Detection event TX_TCLAN detected on PF\n"); 1771 } 1772 1773 reg = rd32(hw, PF_MDET_RX); 1774 if (reg & PF_MDET_RX_VALID_M) { 1775 wr32(hw, PF_MDET_RX, 0xFFFF); 1776 if (netif_msg_rx_err(pf)) 1777 dev_info(dev, "Malicious Driver Detection event RX detected on PF\n"); 1778 } 1779 1780 /* Check to see if one of the VFs caused an MDD event, and then 1781 * increment counters and set print pending 1782 */ 1783 mutex_lock(&pf->vfs.table_lock); 1784 ice_for_each_vf(pf, bkt, vf) { 1785 reg = rd32(hw, VP_MDET_TX_PQM(vf->vf_id)); 1786 if (reg & VP_MDET_TX_PQM_VALID_M) { 1787 wr32(hw, VP_MDET_TX_PQM(vf->vf_id), 0xFFFF); 1788 vf->mdd_tx_events.count++; 1789 set_bit(ICE_MDD_VF_PRINT_PENDING, pf->state); 1790 if (netif_msg_tx_err(pf)) 1791 dev_info(dev, "Malicious Driver Detection event TX_PQM detected on VF %d\n", 1792 vf->vf_id); 1793 } 1794 1795 reg = rd32(hw, VP_MDET_TX_TCLAN(vf->vf_id)); 1796 if (reg & VP_MDET_TX_TCLAN_VALID_M) { 1797 wr32(hw, VP_MDET_TX_TCLAN(vf->vf_id), 0xFFFF); 1798 vf->mdd_tx_events.count++; 1799 set_bit(ICE_MDD_VF_PRINT_PENDING, pf->state); 1800 if (netif_msg_tx_err(pf)) 1801 dev_info(dev, "Malicious Driver Detection event TX_TCLAN detected on VF %d\n", 1802 vf->vf_id); 1803 } 1804 1805 reg = rd32(hw, VP_MDET_TX_TDPU(vf->vf_id)); 1806 if (reg & VP_MDET_TX_TDPU_VALID_M) { 1807 wr32(hw, VP_MDET_TX_TDPU(vf->vf_id), 0xFFFF); 1808 vf->mdd_tx_events.count++; 1809 set_bit(ICE_MDD_VF_PRINT_PENDING, pf->state); 1810 if (netif_msg_tx_err(pf)) 1811 dev_info(dev, "Malicious Driver Detection event TX_TDPU detected on VF %d\n", 1812 vf->vf_id); 1813 } 1814 1815 reg = rd32(hw, VP_MDET_RX(vf->vf_id)); 1816 if (reg & VP_MDET_RX_VALID_M) { 1817 wr32(hw, VP_MDET_RX(vf->vf_id), 0xFFFF); 1818 vf->mdd_rx_events.count++; 1819 set_bit(ICE_MDD_VF_PRINT_PENDING, pf->state); 1820 if (netif_msg_rx_err(pf)) 1821 dev_info(dev, "Malicious Driver Detection event RX detected on VF %d\n", 1822 vf->vf_id); 1823 1824 /* Since the queue is disabled on VF Rx MDD events, the 1825 * PF can be configured to reset the VF through ethtool 1826 * private flag mdd-auto-reset-vf. 1827 */ 1828 if (test_bit(ICE_FLAG_MDD_AUTO_RESET_VF, pf->flags)) { 1829 /* VF MDD event counters will be cleared by 1830 * reset, so print the event prior to reset. 1831 */ 1832 ice_print_vf_rx_mdd_event(vf); 1833 ice_reset_vf(vf, ICE_VF_RESET_LOCK); 1834 } 1835 } 1836 } 1837 mutex_unlock(&pf->vfs.table_lock); 1838 1839 ice_print_vfs_mdd_events(pf); 1840 } 1841 1842 /** 1843 * ice_force_phys_link_state - Force the physical link state 1844 * @vsi: VSI to force the physical link state to up/down 1845 * @link_up: true/false indicates to set the physical link to up/down 1846 * 1847 * Force the physical link state by getting the current PHY capabilities from 1848 * hardware and setting the PHY config based on the determined capabilities. If 1849 * link changes a link event will be triggered because both the Enable Automatic 1850 * Link Update and LESM Enable bits are set when setting the PHY capabilities. 1851 * 1852 * Returns 0 on success, negative on failure 1853 */ 1854 static int ice_force_phys_link_state(struct ice_vsi *vsi, bool link_up) 1855 { 1856 struct ice_aqc_get_phy_caps_data *pcaps; 1857 struct ice_aqc_set_phy_cfg_data *cfg; 1858 struct ice_port_info *pi; 1859 struct device *dev; 1860 int retcode; 1861 1862 if (!vsi || !vsi->port_info || !vsi->back) 1863 return -EINVAL; 1864 if (vsi->type != ICE_VSI_PF) 1865 return 0; 1866 1867 dev = ice_pf_to_dev(vsi->back); 1868 1869 pi = vsi->port_info; 1870 1871 pcaps = kzalloc(sizeof(*pcaps), GFP_KERNEL); 1872 if (!pcaps) 1873 return -ENOMEM; 1874 1875 retcode = ice_aq_get_phy_caps(pi, false, ICE_AQC_REPORT_ACTIVE_CFG, pcaps, 1876 NULL); 1877 if (retcode) { 1878 dev_err(dev, "Failed to get phy capabilities, VSI %d error %d\n", 1879 vsi->vsi_num, retcode); 1880 retcode = -EIO; 1881 goto out; 1882 } 1883 1884 /* No change in link */ 1885 if (link_up == !!(pcaps->caps & ICE_AQC_PHY_EN_LINK) && 1886 link_up == !!(pi->phy.link_info.link_info & ICE_AQ_LINK_UP)) 1887 goto out; 1888 1889 /* Use the current user PHY configuration. The current user PHY 1890 * configuration is initialized during probe from PHY capabilities 1891 * software mode, and updated on set PHY configuration. 1892 */ 1893 cfg = kmemdup(&pi->phy.curr_user_phy_cfg, sizeof(*cfg), GFP_KERNEL); 1894 if (!cfg) { 1895 retcode = -ENOMEM; 1896 goto out; 1897 } 1898 1899 cfg->caps |= ICE_AQ_PHY_ENA_AUTO_LINK_UPDT; 1900 if (link_up) 1901 cfg->caps |= ICE_AQ_PHY_ENA_LINK; 1902 else 1903 cfg->caps &= ~ICE_AQ_PHY_ENA_LINK; 1904 1905 retcode = ice_aq_set_phy_cfg(&vsi->back->hw, pi, cfg, NULL); 1906 if (retcode) { 1907 dev_err(dev, "Failed to set phy config, VSI %d error %d\n", 1908 vsi->vsi_num, retcode); 1909 retcode = -EIO; 1910 } 1911 1912 kfree(cfg); 1913 out: 1914 kfree(pcaps); 1915 return retcode; 1916 } 1917 1918 /** 1919 * ice_init_nvm_phy_type - Initialize the NVM PHY type 1920 * @pi: port info structure 1921 * 1922 * Initialize nvm_phy_type_[low|high] for link lenient mode support 1923 */ 1924 static int ice_init_nvm_phy_type(struct ice_port_info *pi) 1925 { 1926 struct ice_aqc_get_phy_caps_data *pcaps; 1927 struct ice_pf *pf = pi->hw->back; 1928 int err; 1929 1930 pcaps = kzalloc(sizeof(*pcaps), GFP_KERNEL); 1931 if (!pcaps) 1932 return -ENOMEM; 1933 1934 err = ice_aq_get_phy_caps(pi, false, ICE_AQC_REPORT_TOPO_CAP_NO_MEDIA, 1935 pcaps, NULL); 1936 1937 if (err) { 1938 dev_err(ice_pf_to_dev(pf), "Get PHY capability failed.\n"); 1939 goto out; 1940 } 1941 1942 pf->nvm_phy_type_hi = pcaps->phy_type_high; 1943 pf->nvm_phy_type_lo = pcaps->phy_type_low; 1944 1945 out: 1946 kfree(pcaps); 1947 return err; 1948 } 1949 1950 /** 1951 * ice_init_link_dflt_override - Initialize link default override 1952 * @pi: port info structure 1953 * 1954 * Initialize link default override and PHY total port shutdown during probe 1955 */ 1956 static void ice_init_link_dflt_override(struct ice_port_info *pi) 1957 { 1958 struct ice_link_default_override_tlv *ldo; 1959 struct ice_pf *pf = pi->hw->back; 1960 1961 ldo = &pf->link_dflt_override; 1962 if (ice_get_link_default_override(ldo, pi)) 1963 return; 1964 1965 if (!(ldo->options & ICE_LINK_OVERRIDE_PORT_DIS)) 1966 return; 1967 1968 /* Enable Total Port Shutdown (override/replace link-down-on-close 1969 * ethtool private flag) for ports with Port Disable bit set. 1970 */ 1971 set_bit(ICE_FLAG_TOTAL_PORT_SHUTDOWN_ENA, pf->flags); 1972 set_bit(ICE_FLAG_LINK_DOWN_ON_CLOSE_ENA, pf->flags); 1973 } 1974 1975 /** 1976 * ice_init_phy_cfg_dflt_override - Initialize PHY cfg default override settings 1977 * @pi: port info structure 1978 * 1979 * If default override is enabled, initialize the user PHY cfg speed and FEC 1980 * settings using the default override mask from the NVM. 1981 * 1982 * The PHY should only be configured with the default override settings the 1983 * first time media is available. The ICE_LINK_DEFAULT_OVERRIDE_PENDING state 1984 * is used to indicate that the user PHY cfg default override is initialized 1985 * and the PHY has not been configured with the default override settings. The 1986 * state is set here, and cleared in ice_configure_phy the first time the PHY is 1987 * configured. 1988 * 1989 * This function should be called only if the FW doesn't support default 1990 * configuration mode, as reported by ice_fw_supports_report_dflt_cfg. 1991 */ 1992 static void ice_init_phy_cfg_dflt_override(struct ice_port_info *pi) 1993 { 1994 struct ice_link_default_override_tlv *ldo; 1995 struct ice_aqc_set_phy_cfg_data *cfg; 1996 struct ice_phy_info *phy = &pi->phy; 1997 struct ice_pf *pf = pi->hw->back; 1998 1999 ldo = &pf->link_dflt_override; 2000 2001 /* If link default override is enabled, use to mask NVM PHY capabilities 2002 * for speed and FEC default configuration. 2003 */ 2004 cfg = &phy->curr_user_phy_cfg; 2005 2006 if (ldo->phy_type_low || ldo->phy_type_high) { 2007 cfg->phy_type_low = pf->nvm_phy_type_lo & 2008 cpu_to_le64(ldo->phy_type_low); 2009 cfg->phy_type_high = pf->nvm_phy_type_hi & 2010 cpu_to_le64(ldo->phy_type_high); 2011 } 2012 cfg->link_fec_opt = ldo->fec_options; 2013 phy->curr_user_fec_req = ICE_FEC_AUTO; 2014 2015 set_bit(ICE_LINK_DEFAULT_OVERRIDE_PENDING, pf->state); 2016 } 2017 2018 /** 2019 * ice_init_phy_user_cfg - Initialize the PHY user configuration 2020 * @pi: port info structure 2021 * 2022 * Initialize the current user PHY configuration, speed, FEC, and FC requested 2023 * mode to default. The PHY defaults are from get PHY capabilities topology 2024 * with media so call when media is first available. An error is returned if 2025 * called when media is not available. The PHY initialization completed state is 2026 * set here. 2027 * 2028 * These configurations are used when setting PHY 2029 * configuration. The user PHY configuration is updated on set PHY 2030 * configuration. Returns 0 on success, negative on failure 2031 */ 2032 static int ice_init_phy_user_cfg(struct ice_port_info *pi) 2033 { 2034 struct ice_aqc_get_phy_caps_data *pcaps; 2035 struct ice_phy_info *phy = &pi->phy; 2036 struct ice_pf *pf = pi->hw->back; 2037 int err; 2038 2039 if (!(phy->link_info.link_info & ICE_AQ_MEDIA_AVAILABLE)) 2040 return -EIO; 2041 2042 pcaps = kzalloc(sizeof(*pcaps), GFP_KERNEL); 2043 if (!pcaps) 2044 return -ENOMEM; 2045 2046 if (ice_fw_supports_report_dflt_cfg(pi->hw)) 2047 err = ice_aq_get_phy_caps(pi, false, ICE_AQC_REPORT_DFLT_CFG, 2048 pcaps, NULL); 2049 else 2050 err = ice_aq_get_phy_caps(pi, false, ICE_AQC_REPORT_TOPO_CAP_MEDIA, 2051 pcaps, NULL); 2052 if (err) { 2053 dev_err(ice_pf_to_dev(pf), "Get PHY capability failed.\n"); 2054 goto err_out; 2055 } 2056 2057 ice_copy_phy_caps_to_cfg(pi, pcaps, &pi->phy.curr_user_phy_cfg); 2058 2059 /* check if lenient mode is supported and enabled */ 2060 if (ice_fw_supports_link_override(pi->hw) && 2061 !(pcaps->module_compliance_enforcement & 2062 ICE_AQC_MOD_ENFORCE_STRICT_MODE)) { 2063 set_bit(ICE_FLAG_LINK_LENIENT_MODE_ENA, pf->flags); 2064 2065 /* if the FW supports default PHY configuration mode, then the driver 2066 * does not have to apply link override settings. If not, 2067 * initialize user PHY configuration with link override values 2068 */ 2069 if (!ice_fw_supports_report_dflt_cfg(pi->hw) && 2070 (pf->link_dflt_override.options & ICE_LINK_OVERRIDE_EN)) { 2071 ice_init_phy_cfg_dflt_override(pi); 2072 goto out; 2073 } 2074 } 2075 2076 /* if link default override is not enabled, set user flow control and 2077 * FEC settings based on what get_phy_caps returned 2078 */ 2079 phy->curr_user_fec_req = ice_caps_to_fec_mode(pcaps->caps, 2080 pcaps->link_fec_options); 2081 phy->curr_user_fc_req = ice_caps_to_fc_mode(pcaps->caps); 2082 2083 out: 2084 phy->curr_user_speed_req = ICE_AQ_LINK_SPEED_M; 2085 set_bit(ICE_PHY_INIT_COMPLETE, pf->state); 2086 err_out: 2087 kfree(pcaps); 2088 return err; 2089 } 2090 2091 /** 2092 * ice_configure_phy - configure PHY 2093 * @vsi: VSI of PHY 2094 * 2095 * Set the PHY configuration. If the current PHY configuration is the same as 2096 * the curr_user_phy_cfg, then do nothing to avoid link flap. Otherwise 2097 * configure the based get PHY capabilities for topology with media. 2098 */ 2099 static int ice_configure_phy(struct ice_vsi *vsi) 2100 { 2101 struct device *dev = ice_pf_to_dev(vsi->back); 2102 struct ice_port_info *pi = vsi->port_info; 2103 struct ice_aqc_get_phy_caps_data *pcaps; 2104 struct ice_aqc_set_phy_cfg_data *cfg; 2105 struct ice_phy_info *phy = &pi->phy; 2106 struct ice_pf *pf = vsi->back; 2107 int err; 2108 2109 /* Ensure we have media as we cannot configure a medialess port */ 2110 if (!(phy->link_info.link_info & ICE_AQ_MEDIA_AVAILABLE)) 2111 return -EPERM; 2112 2113 ice_print_topo_conflict(vsi); 2114 2115 if (!test_bit(ICE_FLAG_LINK_LENIENT_MODE_ENA, pf->flags) && 2116 phy->link_info.topo_media_conflict == ICE_AQ_LINK_TOPO_UNSUPP_MEDIA) 2117 return -EPERM; 2118 2119 if (test_bit(ICE_FLAG_LINK_DOWN_ON_CLOSE_ENA, pf->flags)) 2120 return ice_force_phys_link_state(vsi, true); 2121 2122 pcaps = kzalloc(sizeof(*pcaps), GFP_KERNEL); 2123 if (!pcaps) 2124 return -ENOMEM; 2125 2126 /* Get current PHY config */ 2127 err = ice_aq_get_phy_caps(pi, false, ICE_AQC_REPORT_ACTIVE_CFG, pcaps, 2128 NULL); 2129 if (err) { 2130 dev_err(dev, "Failed to get PHY configuration, VSI %d error %d\n", 2131 vsi->vsi_num, err); 2132 goto done; 2133 } 2134 2135 /* If PHY enable link is configured and configuration has not changed, 2136 * there's nothing to do 2137 */ 2138 if (pcaps->caps & ICE_AQC_PHY_EN_LINK && 2139 ice_phy_caps_equals_cfg(pcaps, &phy->curr_user_phy_cfg)) 2140 goto done; 2141 2142 /* Use PHY topology as baseline for configuration */ 2143 memset(pcaps, 0, sizeof(*pcaps)); 2144 if (ice_fw_supports_report_dflt_cfg(pi->hw)) 2145 err = ice_aq_get_phy_caps(pi, false, ICE_AQC_REPORT_DFLT_CFG, 2146 pcaps, NULL); 2147 else 2148 err = ice_aq_get_phy_caps(pi, false, ICE_AQC_REPORT_TOPO_CAP_MEDIA, 2149 pcaps, NULL); 2150 if (err) { 2151 dev_err(dev, "Failed to get PHY caps, VSI %d error %d\n", 2152 vsi->vsi_num, err); 2153 goto done; 2154 } 2155 2156 cfg = kzalloc(sizeof(*cfg), GFP_KERNEL); 2157 if (!cfg) { 2158 err = -ENOMEM; 2159 goto done; 2160 } 2161 2162 ice_copy_phy_caps_to_cfg(pi, pcaps, cfg); 2163 2164 /* Speed - If default override pending, use curr_user_phy_cfg set in 2165 * ice_init_phy_user_cfg_ldo. 2166 */ 2167 if (test_and_clear_bit(ICE_LINK_DEFAULT_OVERRIDE_PENDING, 2168 vsi->back->state)) { 2169 cfg->phy_type_low = phy->curr_user_phy_cfg.phy_type_low; 2170 cfg->phy_type_high = phy->curr_user_phy_cfg.phy_type_high; 2171 } else { 2172 u64 phy_low = 0, phy_high = 0; 2173 2174 ice_update_phy_type(&phy_low, &phy_high, 2175 pi->phy.curr_user_speed_req); 2176 cfg->phy_type_low = pcaps->phy_type_low & cpu_to_le64(phy_low); 2177 cfg->phy_type_high = pcaps->phy_type_high & 2178 cpu_to_le64(phy_high); 2179 } 2180 2181 /* Can't provide what was requested; use PHY capabilities */ 2182 if (!cfg->phy_type_low && !cfg->phy_type_high) { 2183 cfg->phy_type_low = pcaps->phy_type_low; 2184 cfg->phy_type_high = pcaps->phy_type_high; 2185 } 2186 2187 /* FEC */ 2188 ice_cfg_phy_fec(pi, cfg, phy->curr_user_fec_req); 2189 2190 /* Can't provide what was requested; use PHY capabilities */ 2191 if (cfg->link_fec_opt != 2192 (cfg->link_fec_opt & pcaps->link_fec_options)) { 2193 cfg->caps |= pcaps->caps & ICE_AQC_PHY_EN_AUTO_FEC; 2194 cfg->link_fec_opt = pcaps->link_fec_options; 2195 } 2196 2197 /* Flow Control - always supported; no need to check against 2198 * capabilities 2199 */ 2200 ice_cfg_phy_fc(pi, cfg, phy->curr_user_fc_req); 2201 2202 /* Enable link and link update */ 2203 cfg->caps |= ICE_AQ_PHY_ENA_AUTO_LINK_UPDT | ICE_AQ_PHY_ENA_LINK; 2204 2205 err = ice_aq_set_phy_cfg(&pf->hw, pi, cfg, NULL); 2206 if (err) 2207 dev_err(dev, "Failed to set phy config, VSI %d error %d\n", 2208 vsi->vsi_num, err); 2209 2210 kfree(cfg); 2211 done: 2212 kfree(pcaps); 2213 return err; 2214 } 2215 2216 /** 2217 * ice_check_media_subtask - Check for media 2218 * @pf: pointer to PF struct 2219 * 2220 * If media is available, then initialize PHY user configuration if it is not 2221 * been, and configure the PHY if the interface is up. 2222 */ 2223 static void ice_check_media_subtask(struct ice_pf *pf) 2224 { 2225 struct ice_port_info *pi; 2226 struct ice_vsi *vsi; 2227 int err; 2228 2229 /* No need to check for media if it's already present */ 2230 if (!test_bit(ICE_FLAG_NO_MEDIA, pf->flags)) 2231 return; 2232 2233 vsi = ice_get_main_vsi(pf); 2234 if (!vsi) 2235 return; 2236 2237 /* Refresh link info and check if media is present */ 2238 pi = vsi->port_info; 2239 err = ice_update_link_info(pi); 2240 if (err) 2241 return; 2242 2243 ice_check_link_cfg_err(pf, pi->phy.link_info.link_cfg_err); 2244 2245 if (pi->phy.link_info.link_info & ICE_AQ_MEDIA_AVAILABLE) { 2246 if (!test_bit(ICE_PHY_INIT_COMPLETE, pf->state)) 2247 ice_init_phy_user_cfg(pi); 2248 2249 /* PHY settings are reset on media insertion, reconfigure 2250 * PHY to preserve settings. 2251 */ 2252 if (test_bit(ICE_VSI_DOWN, vsi->state) && 2253 test_bit(ICE_FLAG_LINK_DOWN_ON_CLOSE_ENA, vsi->back->flags)) 2254 return; 2255 2256 err = ice_configure_phy(vsi); 2257 if (!err) 2258 clear_bit(ICE_FLAG_NO_MEDIA, pf->flags); 2259 2260 /* A Link Status Event will be generated; the event handler 2261 * will complete bringing the interface up 2262 */ 2263 } 2264 } 2265 2266 /** 2267 * ice_service_task - manage and run subtasks 2268 * @work: pointer to work_struct contained by the PF struct 2269 */ 2270 static void ice_service_task(struct work_struct *work) 2271 { 2272 struct ice_pf *pf = container_of(work, struct ice_pf, serv_task); 2273 unsigned long start_time = jiffies; 2274 2275 /* subtasks */ 2276 2277 /* process reset requests first */ 2278 ice_reset_subtask(pf); 2279 2280 /* bail if a reset/recovery cycle is pending or rebuild failed */ 2281 if (ice_is_reset_in_progress(pf->state) || 2282 test_bit(ICE_SUSPENDED, pf->state) || 2283 test_bit(ICE_NEEDS_RESTART, pf->state)) { 2284 ice_service_task_complete(pf); 2285 return; 2286 } 2287 2288 if (test_and_clear_bit(ICE_AUX_ERR_PENDING, pf->state)) { 2289 struct iidc_event *event; 2290 2291 event = kzalloc(sizeof(*event), GFP_KERNEL); 2292 if (event) { 2293 set_bit(IIDC_EVENT_CRIT_ERR, event->type); 2294 /* report the entire OICR value to AUX driver */ 2295 swap(event->reg, pf->oicr_err_reg); 2296 ice_send_event_to_aux(pf, event); 2297 kfree(event); 2298 } 2299 } 2300 2301 if (test_bit(ICE_FLAG_PLUG_AUX_DEV, pf->flags)) { 2302 /* Plug aux device per request */ 2303 ice_plug_aux_dev(pf); 2304 2305 /* Mark plugging as done but check whether unplug was 2306 * requested during ice_plug_aux_dev() call 2307 * (e.g. from ice_clear_rdma_cap()) and if so then 2308 * plug aux device. 2309 */ 2310 if (!test_and_clear_bit(ICE_FLAG_PLUG_AUX_DEV, pf->flags)) 2311 ice_unplug_aux_dev(pf); 2312 } 2313 2314 if (test_and_clear_bit(ICE_FLAG_MTU_CHANGED, pf->flags)) { 2315 struct iidc_event *event; 2316 2317 event = kzalloc(sizeof(*event), GFP_KERNEL); 2318 if (event) { 2319 set_bit(IIDC_EVENT_AFTER_MTU_CHANGE, event->type); 2320 ice_send_event_to_aux(pf, event); 2321 kfree(event); 2322 } 2323 } 2324 2325 ice_clean_adminq_subtask(pf); 2326 ice_check_media_subtask(pf); 2327 ice_check_for_hang_subtask(pf); 2328 ice_sync_fltr_subtask(pf); 2329 ice_handle_mdd_event(pf); 2330 ice_watchdog_subtask(pf); 2331 2332 if (ice_is_safe_mode(pf)) { 2333 ice_service_task_complete(pf); 2334 return; 2335 } 2336 2337 ice_process_vflr_event(pf); 2338 ice_clean_mailboxq_subtask(pf); 2339 ice_clean_sbq_subtask(pf); 2340 ice_sync_arfs_fltrs(pf); 2341 ice_flush_fdir_ctx(pf); 2342 2343 /* Clear ICE_SERVICE_SCHED flag to allow scheduling next event */ 2344 ice_service_task_complete(pf); 2345 2346 /* If the tasks have taken longer than one service timer period 2347 * or there is more work to be done, reset the service timer to 2348 * schedule the service task now. 2349 */ 2350 if (time_after(jiffies, (start_time + pf->serv_tmr_period)) || 2351 test_bit(ICE_MDD_EVENT_PENDING, pf->state) || 2352 test_bit(ICE_VFLR_EVENT_PENDING, pf->state) || 2353 test_bit(ICE_MAILBOXQ_EVENT_PENDING, pf->state) || 2354 test_bit(ICE_FD_VF_FLUSH_CTX, pf->state) || 2355 test_bit(ICE_SIDEBANDQ_EVENT_PENDING, pf->state) || 2356 test_bit(ICE_ADMINQ_EVENT_PENDING, pf->state)) 2357 mod_timer(&pf->serv_tmr, jiffies); 2358 } 2359 2360 /** 2361 * ice_set_ctrlq_len - helper function to set controlq length 2362 * @hw: pointer to the HW instance 2363 */ 2364 static void ice_set_ctrlq_len(struct ice_hw *hw) 2365 { 2366 hw->adminq.num_rq_entries = ICE_AQ_LEN; 2367 hw->adminq.num_sq_entries = ICE_AQ_LEN; 2368 hw->adminq.rq_buf_size = ICE_AQ_MAX_BUF_LEN; 2369 hw->adminq.sq_buf_size = ICE_AQ_MAX_BUF_LEN; 2370 hw->mailboxq.num_rq_entries = PF_MBX_ARQLEN_ARQLEN_M; 2371 hw->mailboxq.num_sq_entries = ICE_MBXSQ_LEN; 2372 hw->mailboxq.rq_buf_size = ICE_MBXQ_MAX_BUF_LEN; 2373 hw->mailboxq.sq_buf_size = ICE_MBXQ_MAX_BUF_LEN; 2374 hw->sbq.num_rq_entries = ICE_SBQ_LEN; 2375 hw->sbq.num_sq_entries = ICE_SBQ_LEN; 2376 hw->sbq.rq_buf_size = ICE_SBQ_MAX_BUF_LEN; 2377 hw->sbq.sq_buf_size = ICE_SBQ_MAX_BUF_LEN; 2378 } 2379 2380 /** 2381 * ice_schedule_reset - schedule a reset 2382 * @pf: board private structure 2383 * @reset: reset being requested 2384 */ 2385 int ice_schedule_reset(struct ice_pf *pf, enum ice_reset_req reset) 2386 { 2387 struct device *dev = ice_pf_to_dev(pf); 2388 2389 /* bail out if earlier reset has failed */ 2390 if (test_bit(ICE_RESET_FAILED, pf->state)) { 2391 dev_dbg(dev, "earlier reset has failed\n"); 2392 return -EIO; 2393 } 2394 /* bail if reset/recovery already in progress */ 2395 if (ice_is_reset_in_progress(pf->state)) { 2396 dev_dbg(dev, "Reset already in progress\n"); 2397 return -EBUSY; 2398 } 2399 2400 ice_unplug_aux_dev(pf); 2401 2402 switch (reset) { 2403 case ICE_RESET_PFR: 2404 set_bit(ICE_PFR_REQ, pf->state); 2405 break; 2406 case ICE_RESET_CORER: 2407 set_bit(ICE_CORER_REQ, pf->state); 2408 break; 2409 case ICE_RESET_GLOBR: 2410 set_bit(ICE_GLOBR_REQ, pf->state); 2411 break; 2412 default: 2413 return -EINVAL; 2414 } 2415 2416 ice_service_task_schedule(pf); 2417 return 0; 2418 } 2419 2420 /** 2421 * ice_irq_affinity_notify - Callback for affinity changes 2422 * @notify: context as to what irq was changed 2423 * @mask: the new affinity mask 2424 * 2425 * This is a callback function used by the irq_set_affinity_notifier function 2426 * so that we may register to receive changes to the irq affinity masks. 2427 */ 2428 static void 2429 ice_irq_affinity_notify(struct irq_affinity_notify *notify, 2430 const cpumask_t *mask) 2431 { 2432 struct ice_q_vector *q_vector = 2433 container_of(notify, struct ice_q_vector, affinity_notify); 2434 2435 cpumask_copy(&q_vector->affinity_mask, mask); 2436 } 2437 2438 /** 2439 * ice_irq_affinity_release - Callback for affinity notifier release 2440 * @ref: internal core kernel usage 2441 * 2442 * This is a callback function used by the irq_set_affinity_notifier function 2443 * to inform the current notification subscriber that they will no longer 2444 * receive notifications. 2445 */ 2446 static void ice_irq_affinity_release(struct kref __always_unused *ref) {} 2447 2448 /** 2449 * ice_vsi_ena_irq - Enable IRQ for the given VSI 2450 * @vsi: the VSI being configured 2451 */ 2452 static int ice_vsi_ena_irq(struct ice_vsi *vsi) 2453 { 2454 struct ice_hw *hw = &vsi->back->hw; 2455 int i; 2456 2457 ice_for_each_q_vector(vsi, i) 2458 ice_irq_dynamic_ena(hw, vsi, vsi->q_vectors[i]); 2459 2460 ice_flush(hw); 2461 return 0; 2462 } 2463 2464 /** 2465 * ice_vsi_req_irq_msix - get MSI-X vectors from the OS for the VSI 2466 * @vsi: the VSI being configured 2467 * @basename: name for the vector 2468 */ 2469 static int ice_vsi_req_irq_msix(struct ice_vsi *vsi, char *basename) 2470 { 2471 int q_vectors = vsi->num_q_vectors; 2472 struct ice_pf *pf = vsi->back; 2473 int base = vsi->base_vector; 2474 struct device *dev; 2475 int rx_int_idx = 0; 2476 int tx_int_idx = 0; 2477 int vector, err; 2478 int irq_num; 2479 2480 dev = ice_pf_to_dev(pf); 2481 for (vector = 0; vector < q_vectors; vector++) { 2482 struct ice_q_vector *q_vector = vsi->q_vectors[vector]; 2483 2484 irq_num = pf->msix_entries[base + vector].vector; 2485 2486 if (q_vector->tx.tx_ring && q_vector->rx.rx_ring) { 2487 snprintf(q_vector->name, sizeof(q_vector->name) - 1, 2488 "%s-%s-%d", basename, "TxRx", rx_int_idx++); 2489 tx_int_idx++; 2490 } else if (q_vector->rx.rx_ring) { 2491 snprintf(q_vector->name, sizeof(q_vector->name) - 1, 2492 "%s-%s-%d", basename, "rx", rx_int_idx++); 2493 } else if (q_vector->tx.tx_ring) { 2494 snprintf(q_vector->name, sizeof(q_vector->name) - 1, 2495 "%s-%s-%d", basename, "tx", tx_int_idx++); 2496 } else { 2497 /* skip this unused q_vector */ 2498 continue; 2499 } 2500 if (vsi->type == ICE_VSI_CTRL && vsi->vf) 2501 err = devm_request_irq(dev, irq_num, vsi->irq_handler, 2502 IRQF_SHARED, q_vector->name, 2503 q_vector); 2504 else 2505 err = devm_request_irq(dev, irq_num, vsi->irq_handler, 2506 0, q_vector->name, q_vector); 2507 if (err) { 2508 netdev_err(vsi->netdev, "MSIX request_irq failed, error: %d\n", 2509 err); 2510 goto free_q_irqs; 2511 } 2512 2513 /* register for affinity change notifications */ 2514 if (!IS_ENABLED(CONFIG_RFS_ACCEL)) { 2515 struct irq_affinity_notify *affinity_notify; 2516 2517 affinity_notify = &q_vector->affinity_notify; 2518 affinity_notify->notify = ice_irq_affinity_notify; 2519 affinity_notify->release = ice_irq_affinity_release; 2520 irq_set_affinity_notifier(irq_num, affinity_notify); 2521 } 2522 2523 /* assign the mask for this irq */ 2524 irq_set_affinity_hint(irq_num, &q_vector->affinity_mask); 2525 } 2526 2527 err = ice_set_cpu_rx_rmap(vsi); 2528 if (err) { 2529 netdev_err(vsi->netdev, "Failed to setup CPU RMAP on VSI %u: %pe\n", 2530 vsi->vsi_num, ERR_PTR(err)); 2531 goto free_q_irqs; 2532 } 2533 2534 vsi->irqs_ready = true; 2535 return 0; 2536 2537 free_q_irqs: 2538 while (vector) { 2539 vector--; 2540 irq_num = pf->msix_entries[base + vector].vector; 2541 if (!IS_ENABLED(CONFIG_RFS_ACCEL)) 2542 irq_set_affinity_notifier(irq_num, NULL); 2543 irq_set_affinity_hint(irq_num, NULL); 2544 devm_free_irq(dev, irq_num, &vsi->q_vectors[vector]); 2545 } 2546 return err; 2547 } 2548 2549 /** 2550 * ice_xdp_alloc_setup_rings - Allocate and setup Tx rings for XDP 2551 * @vsi: VSI to setup Tx rings used by XDP 2552 * 2553 * Return 0 on success and negative value on error 2554 */ 2555 static int ice_xdp_alloc_setup_rings(struct ice_vsi *vsi) 2556 { 2557 struct device *dev = ice_pf_to_dev(vsi->back); 2558 struct ice_tx_desc *tx_desc; 2559 int i, j; 2560 2561 ice_for_each_xdp_txq(vsi, i) { 2562 u16 xdp_q_idx = vsi->alloc_txq + i; 2563 struct ice_tx_ring *xdp_ring; 2564 2565 xdp_ring = kzalloc(sizeof(*xdp_ring), GFP_KERNEL); 2566 2567 if (!xdp_ring) 2568 goto free_xdp_rings; 2569 2570 xdp_ring->q_index = xdp_q_idx; 2571 xdp_ring->reg_idx = vsi->txq_map[xdp_q_idx]; 2572 xdp_ring->vsi = vsi; 2573 xdp_ring->netdev = NULL; 2574 xdp_ring->dev = dev; 2575 xdp_ring->count = vsi->num_tx_desc; 2576 xdp_ring->next_dd = ICE_RING_QUARTER(xdp_ring) - 1; 2577 xdp_ring->next_rs = ICE_RING_QUARTER(xdp_ring) - 1; 2578 WRITE_ONCE(vsi->xdp_rings[i], xdp_ring); 2579 if (ice_setup_tx_ring(xdp_ring)) 2580 goto free_xdp_rings; 2581 ice_set_ring_xdp(xdp_ring); 2582 xdp_ring->xsk_pool = ice_tx_xsk_pool(xdp_ring); 2583 spin_lock_init(&xdp_ring->tx_lock); 2584 for (j = 0; j < xdp_ring->count; j++) { 2585 tx_desc = ICE_TX_DESC(xdp_ring, j); 2586 tx_desc->cmd_type_offset_bsz = 0; 2587 } 2588 } 2589 2590 ice_for_each_rxq(vsi, i) { 2591 if (static_key_enabled(&ice_xdp_locking_key)) 2592 vsi->rx_rings[i]->xdp_ring = vsi->xdp_rings[i % vsi->num_xdp_txq]; 2593 else 2594 vsi->rx_rings[i]->xdp_ring = vsi->xdp_rings[i]; 2595 } 2596 2597 return 0; 2598 2599 free_xdp_rings: 2600 for (; i >= 0; i--) 2601 if (vsi->xdp_rings[i] && vsi->xdp_rings[i]->desc) 2602 ice_free_tx_ring(vsi->xdp_rings[i]); 2603 return -ENOMEM; 2604 } 2605 2606 /** 2607 * ice_vsi_assign_bpf_prog - set or clear bpf prog pointer on VSI 2608 * @vsi: VSI to set the bpf prog on 2609 * @prog: the bpf prog pointer 2610 */ 2611 static void ice_vsi_assign_bpf_prog(struct ice_vsi *vsi, struct bpf_prog *prog) 2612 { 2613 struct bpf_prog *old_prog; 2614 int i; 2615 2616 old_prog = xchg(&vsi->xdp_prog, prog); 2617 if (old_prog) 2618 bpf_prog_put(old_prog); 2619 2620 ice_for_each_rxq(vsi, i) 2621 WRITE_ONCE(vsi->rx_rings[i]->xdp_prog, vsi->xdp_prog); 2622 } 2623 2624 /** 2625 * ice_prepare_xdp_rings - Allocate, configure and setup Tx rings for XDP 2626 * @vsi: VSI to bring up Tx rings used by XDP 2627 * @prog: bpf program that will be assigned to VSI 2628 * 2629 * Return 0 on success and negative value on error 2630 */ 2631 int ice_prepare_xdp_rings(struct ice_vsi *vsi, struct bpf_prog *prog) 2632 { 2633 u16 max_txqs[ICE_MAX_TRAFFIC_CLASS] = { 0 }; 2634 int xdp_rings_rem = vsi->num_xdp_txq; 2635 struct ice_pf *pf = vsi->back; 2636 struct ice_qs_cfg xdp_qs_cfg = { 2637 .qs_mutex = &pf->avail_q_mutex, 2638 .pf_map = pf->avail_txqs, 2639 .pf_map_size = pf->max_pf_txqs, 2640 .q_count = vsi->num_xdp_txq, 2641 .scatter_count = ICE_MAX_SCATTER_TXQS, 2642 .vsi_map = vsi->txq_map, 2643 .vsi_map_offset = vsi->alloc_txq, 2644 .mapping_mode = ICE_VSI_MAP_CONTIG 2645 }; 2646 struct device *dev; 2647 int i, v_idx; 2648 int status; 2649 2650 dev = ice_pf_to_dev(pf); 2651 vsi->xdp_rings = devm_kcalloc(dev, vsi->num_xdp_txq, 2652 sizeof(*vsi->xdp_rings), GFP_KERNEL); 2653 if (!vsi->xdp_rings) 2654 return -ENOMEM; 2655 2656 vsi->xdp_mapping_mode = xdp_qs_cfg.mapping_mode; 2657 if (__ice_vsi_get_qs(&xdp_qs_cfg)) 2658 goto err_map_xdp; 2659 2660 if (static_key_enabled(&ice_xdp_locking_key)) 2661 netdev_warn(vsi->netdev, 2662 "Could not allocate one XDP Tx ring per CPU, XDP_TX/XDP_REDIRECT actions will be slower\n"); 2663 2664 if (ice_xdp_alloc_setup_rings(vsi)) 2665 goto clear_xdp_rings; 2666 2667 /* follow the logic from ice_vsi_map_rings_to_vectors */ 2668 ice_for_each_q_vector(vsi, v_idx) { 2669 struct ice_q_vector *q_vector = vsi->q_vectors[v_idx]; 2670 int xdp_rings_per_v, q_id, q_base; 2671 2672 xdp_rings_per_v = DIV_ROUND_UP(xdp_rings_rem, 2673 vsi->num_q_vectors - v_idx); 2674 q_base = vsi->num_xdp_txq - xdp_rings_rem; 2675 2676 for (q_id = q_base; q_id < (q_base + xdp_rings_per_v); q_id++) { 2677 struct ice_tx_ring *xdp_ring = vsi->xdp_rings[q_id]; 2678 2679 xdp_ring->q_vector = q_vector; 2680 xdp_ring->next = q_vector->tx.tx_ring; 2681 q_vector->tx.tx_ring = xdp_ring; 2682 } 2683 xdp_rings_rem -= xdp_rings_per_v; 2684 } 2685 2686 /* omit the scheduler update if in reset path; XDP queues will be 2687 * taken into account at the end of ice_vsi_rebuild, where 2688 * ice_cfg_vsi_lan is being called 2689 */ 2690 if (ice_is_reset_in_progress(pf->state)) 2691 return 0; 2692 2693 /* tell the Tx scheduler that right now we have 2694 * additional queues 2695 */ 2696 for (i = 0; i < vsi->tc_cfg.numtc; i++) 2697 max_txqs[i] = vsi->num_txq + vsi->num_xdp_txq; 2698 2699 status = ice_cfg_vsi_lan(vsi->port_info, vsi->idx, vsi->tc_cfg.ena_tc, 2700 max_txqs); 2701 if (status) { 2702 dev_err(dev, "Failed VSI LAN queue config for XDP, error: %d\n", 2703 status); 2704 goto clear_xdp_rings; 2705 } 2706 2707 /* assign the prog only when it's not already present on VSI; 2708 * this flow is a subject of both ethtool -L and ndo_bpf flows; 2709 * VSI rebuild that happens under ethtool -L can expose us to 2710 * the bpf_prog refcount issues as we would be swapping same 2711 * bpf_prog pointers from vsi->xdp_prog and calling bpf_prog_put 2712 * on it as it would be treated as an 'old_prog'; for ndo_bpf 2713 * this is not harmful as dev_xdp_install bumps the refcount 2714 * before calling the op exposed by the driver; 2715 */ 2716 if (!ice_is_xdp_ena_vsi(vsi)) 2717 ice_vsi_assign_bpf_prog(vsi, prog); 2718 2719 return 0; 2720 clear_xdp_rings: 2721 ice_for_each_xdp_txq(vsi, i) 2722 if (vsi->xdp_rings[i]) { 2723 kfree_rcu(vsi->xdp_rings[i], rcu); 2724 vsi->xdp_rings[i] = NULL; 2725 } 2726 2727 err_map_xdp: 2728 mutex_lock(&pf->avail_q_mutex); 2729 ice_for_each_xdp_txq(vsi, i) { 2730 clear_bit(vsi->txq_map[i + vsi->alloc_txq], pf->avail_txqs); 2731 vsi->txq_map[i + vsi->alloc_txq] = ICE_INVAL_Q_INDEX; 2732 } 2733 mutex_unlock(&pf->avail_q_mutex); 2734 2735 devm_kfree(dev, vsi->xdp_rings); 2736 return -ENOMEM; 2737 } 2738 2739 /** 2740 * ice_destroy_xdp_rings - undo the configuration made by ice_prepare_xdp_rings 2741 * @vsi: VSI to remove XDP rings 2742 * 2743 * Detach XDP rings from irq vectors, clean up the PF bitmap and free 2744 * resources 2745 */ 2746 int ice_destroy_xdp_rings(struct ice_vsi *vsi) 2747 { 2748 u16 max_txqs[ICE_MAX_TRAFFIC_CLASS] = { 0 }; 2749 struct ice_pf *pf = vsi->back; 2750 int i, v_idx; 2751 2752 /* q_vectors are freed in reset path so there's no point in detaching 2753 * rings; in case of rebuild being triggered not from reset bits 2754 * in pf->state won't be set, so additionally check first q_vector 2755 * against NULL 2756 */ 2757 if (ice_is_reset_in_progress(pf->state) || !vsi->q_vectors[0]) 2758 goto free_qmap; 2759 2760 ice_for_each_q_vector(vsi, v_idx) { 2761 struct ice_q_vector *q_vector = vsi->q_vectors[v_idx]; 2762 struct ice_tx_ring *ring; 2763 2764 ice_for_each_tx_ring(ring, q_vector->tx) 2765 if (!ring->tx_buf || !ice_ring_is_xdp(ring)) 2766 break; 2767 2768 /* restore the value of last node prior to XDP setup */ 2769 q_vector->tx.tx_ring = ring; 2770 } 2771 2772 free_qmap: 2773 mutex_lock(&pf->avail_q_mutex); 2774 ice_for_each_xdp_txq(vsi, i) { 2775 clear_bit(vsi->txq_map[i + vsi->alloc_txq], pf->avail_txqs); 2776 vsi->txq_map[i + vsi->alloc_txq] = ICE_INVAL_Q_INDEX; 2777 } 2778 mutex_unlock(&pf->avail_q_mutex); 2779 2780 ice_for_each_xdp_txq(vsi, i) 2781 if (vsi->xdp_rings[i]) { 2782 if (vsi->xdp_rings[i]->desc) { 2783 synchronize_rcu(); 2784 ice_free_tx_ring(vsi->xdp_rings[i]); 2785 } 2786 kfree_rcu(vsi->xdp_rings[i], rcu); 2787 vsi->xdp_rings[i] = NULL; 2788 } 2789 2790 devm_kfree(ice_pf_to_dev(pf), vsi->xdp_rings); 2791 vsi->xdp_rings = NULL; 2792 2793 if (static_key_enabled(&ice_xdp_locking_key)) 2794 static_branch_dec(&ice_xdp_locking_key); 2795 2796 if (ice_is_reset_in_progress(pf->state) || !vsi->q_vectors[0]) 2797 return 0; 2798 2799 ice_vsi_assign_bpf_prog(vsi, NULL); 2800 2801 /* notify Tx scheduler that we destroyed XDP queues and bring 2802 * back the old number of child nodes 2803 */ 2804 for (i = 0; i < vsi->tc_cfg.numtc; i++) 2805 max_txqs[i] = vsi->num_txq; 2806 2807 /* change number of XDP Tx queues to 0 */ 2808 vsi->num_xdp_txq = 0; 2809 2810 return ice_cfg_vsi_lan(vsi->port_info, vsi->idx, vsi->tc_cfg.ena_tc, 2811 max_txqs); 2812 } 2813 2814 /** 2815 * ice_vsi_rx_napi_schedule - Schedule napi on RX queues from VSI 2816 * @vsi: VSI to schedule napi on 2817 */ 2818 static void ice_vsi_rx_napi_schedule(struct ice_vsi *vsi) 2819 { 2820 int i; 2821 2822 ice_for_each_rxq(vsi, i) { 2823 struct ice_rx_ring *rx_ring = vsi->rx_rings[i]; 2824 2825 if (rx_ring->xsk_pool) 2826 napi_schedule(&rx_ring->q_vector->napi); 2827 } 2828 } 2829 2830 /** 2831 * ice_vsi_determine_xdp_res - figure out how many Tx qs can XDP have 2832 * @vsi: VSI to determine the count of XDP Tx qs 2833 * 2834 * returns 0 if Tx qs count is higher than at least half of CPU count, 2835 * -ENOMEM otherwise 2836 */ 2837 int ice_vsi_determine_xdp_res(struct ice_vsi *vsi) 2838 { 2839 u16 avail = ice_get_avail_txq_count(vsi->back); 2840 u16 cpus = num_possible_cpus(); 2841 2842 if (avail < cpus / 2) 2843 return -ENOMEM; 2844 2845 vsi->num_xdp_txq = min_t(u16, avail, cpus); 2846 2847 if (vsi->num_xdp_txq < cpus) 2848 static_branch_inc(&ice_xdp_locking_key); 2849 2850 return 0; 2851 } 2852 2853 /** 2854 * ice_xdp_setup_prog - Add or remove XDP eBPF program 2855 * @vsi: VSI to setup XDP for 2856 * @prog: XDP program 2857 * @extack: netlink extended ack 2858 */ 2859 static int 2860 ice_xdp_setup_prog(struct ice_vsi *vsi, struct bpf_prog *prog, 2861 struct netlink_ext_ack *extack) 2862 { 2863 int frame_size = vsi->netdev->mtu + ICE_ETH_PKT_HDR_PAD; 2864 bool if_running = netif_running(vsi->netdev); 2865 int ret = 0, xdp_ring_err = 0; 2866 2867 if (frame_size > vsi->rx_buf_len) { 2868 NL_SET_ERR_MSG_MOD(extack, "MTU too large for loading XDP"); 2869 return -EOPNOTSUPP; 2870 } 2871 2872 /* need to stop netdev while setting up the program for Rx rings */ 2873 if (if_running && !test_and_set_bit(ICE_VSI_DOWN, vsi->state)) { 2874 ret = ice_down(vsi); 2875 if (ret) { 2876 NL_SET_ERR_MSG_MOD(extack, "Preparing device for XDP attach failed"); 2877 return ret; 2878 } 2879 } 2880 2881 if (!ice_is_xdp_ena_vsi(vsi) && prog) { 2882 xdp_ring_err = ice_vsi_determine_xdp_res(vsi); 2883 if (xdp_ring_err) { 2884 NL_SET_ERR_MSG_MOD(extack, "Not enough Tx resources for XDP"); 2885 } else { 2886 xdp_ring_err = ice_prepare_xdp_rings(vsi, prog); 2887 if (xdp_ring_err) 2888 NL_SET_ERR_MSG_MOD(extack, "Setting up XDP Tx resources failed"); 2889 } 2890 } else if (ice_is_xdp_ena_vsi(vsi) && !prog) { 2891 xdp_ring_err = ice_destroy_xdp_rings(vsi); 2892 if (xdp_ring_err) 2893 NL_SET_ERR_MSG_MOD(extack, "Freeing XDP Tx resources failed"); 2894 } else { 2895 /* safe to call even when prog == vsi->xdp_prog as 2896 * dev_xdp_install in net/core/dev.c incremented prog's 2897 * refcount so corresponding bpf_prog_put won't cause 2898 * underflow 2899 */ 2900 ice_vsi_assign_bpf_prog(vsi, prog); 2901 } 2902 2903 if (if_running) 2904 ret = ice_up(vsi); 2905 2906 if (!ret && prog) 2907 ice_vsi_rx_napi_schedule(vsi); 2908 2909 return (ret || xdp_ring_err) ? -ENOMEM : 0; 2910 } 2911 2912 /** 2913 * ice_xdp_safe_mode - XDP handler for safe mode 2914 * @dev: netdevice 2915 * @xdp: XDP command 2916 */ 2917 static int ice_xdp_safe_mode(struct net_device __always_unused *dev, 2918 struct netdev_bpf *xdp) 2919 { 2920 NL_SET_ERR_MSG_MOD(xdp->extack, 2921 "Please provide working DDP firmware package in order to use XDP\n" 2922 "Refer to Documentation/networking/device_drivers/ethernet/intel/ice.rst"); 2923 return -EOPNOTSUPP; 2924 } 2925 2926 /** 2927 * ice_xdp - implements XDP handler 2928 * @dev: netdevice 2929 * @xdp: XDP command 2930 */ 2931 static int ice_xdp(struct net_device *dev, struct netdev_bpf *xdp) 2932 { 2933 struct ice_netdev_priv *np = netdev_priv(dev); 2934 struct ice_vsi *vsi = np->vsi; 2935 2936 if (vsi->type != ICE_VSI_PF) { 2937 NL_SET_ERR_MSG_MOD(xdp->extack, "XDP can be loaded only on PF VSI"); 2938 return -EINVAL; 2939 } 2940 2941 switch (xdp->command) { 2942 case XDP_SETUP_PROG: 2943 return ice_xdp_setup_prog(vsi, xdp->prog, xdp->extack); 2944 case XDP_SETUP_XSK_POOL: 2945 return ice_xsk_pool_setup(vsi, xdp->xsk.pool, 2946 xdp->xsk.queue_id); 2947 default: 2948 return -EINVAL; 2949 } 2950 } 2951 2952 /** 2953 * ice_ena_misc_vector - enable the non-queue interrupts 2954 * @pf: board private structure 2955 */ 2956 static void ice_ena_misc_vector(struct ice_pf *pf) 2957 { 2958 struct ice_hw *hw = &pf->hw; 2959 u32 val; 2960 2961 /* Disable anti-spoof detection interrupt to prevent spurious event 2962 * interrupts during a function reset. Anti-spoof functionally is 2963 * still supported. 2964 */ 2965 val = rd32(hw, GL_MDCK_TX_TDPU); 2966 val |= GL_MDCK_TX_TDPU_RCU_ANTISPOOF_ITR_DIS_M; 2967 wr32(hw, GL_MDCK_TX_TDPU, val); 2968 2969 /* clear things first */ 2970 wr32(hw, PFINT_OICR_ENA, 0); /* disable all */ 2971 rd32(hw, PFINT_OICR); /* read to clear */ 2972 2973 val = (PFINT_OICR_ECC_ERR_M | 2974 PFINT_OICR_MAL_DETECT_M | 2975 PFINT_OICR_GRST_M | 2976 PFINT_OICR_PCI_EXCEPTION_M | 2977 PFINT_OICR_VFLR_M | 2978 PFINT_OICR_HMC_ERR_M | 2979 PFINT_OICR_PE_PUSH_M | 2980 PFINT_OICR_PE_CRITERR_M); 2981 2982 wr32(hw, PFINT_OICR_ENA, val); 2983 2984 /* SW_ITR_IDX = 0, but don't change INTENA */ 2985 wr32(hw, GLINT_DYN_CTL(pf->oicr_idx), 2986 GLINT_DYN_CTL_SW_ITR_INDX_M | GLINT_DYN_CTL_INTENA_MSK_M); 2987 } 2988 2989 /** 2990 * ice_misc_intr - misc interrupt handler 2991 * @irq: interrupt number 2992 * @data: pointer to a q_vector 2993 */ 2994 static irqreturn_t ice_misc_intr(int __always_unused irq, void *data) 2995 { 2996 struct ice_pf *pf = (struct ice_pf *)data; 2997 struct ice_hw *hw = &pf->hw; 2998 irqreturn_t ret = IRQ_NONE; 2999 struct device *dev; 3000 u32 oicr, ena_mask; 3001 3002 dev = ice_pf_to_dev(pf); 3003 set_bit(ICE_ADMINQ_EVENT_PENDING, pf->state); 3004 set_bit(ICE_MAILBOXQ_EVENT_PENDING, pf->state); 3005 set_bit(ICE_SIDEBANDQ_EVENT_PENDING, pf->state); 3006 3007 oicr = rd32(hw, PFINT_OICR); 3008 ena_mask = rd32(hw, PFINT_OICR_ENA); 3009 3010 if (oicr & PFINT_OICR_SWINT_M) { 3011 ena_mask &= ~PFINT_OICR_SWINT_M; 3012 pf->sw_int_count++; 3013 } 3014 3015 if (oicr & PFINT_OICR_MAL_DETECT_M) { 3016 ena_mask &= ~PFINT_OICR_MAL_DETECT_M; 3017 set_bit(ICE_MDD_EVENT_PENDING, pf->state); 3018 } 3019 if (oicr & PFINT_OICR_VFLR_M) { 3020 /* disable any further VFLR event notifications */ 3021 if (test_bit(ICE_VF_RESETS_DISABLED, pf->state)) { 3022 u32 reg = rd32(hw, PFINT_OICR_ENA); 3023 3024 reg &= ~PFINT_OICR_VFLR_M; 3025 wr32(hw, PFINT_OICR_ENA, reg); 3026 } else { 3027 ena_mask &= ~PFINT_OICR_VFLR_M; 3028 set_bit(ICE_VFLR_EVENT_PENDING, pf->state); 3029 } 3030 } 3031 3032 if (oicr & PFINT_OICR_GRST_M) { 3033 u32 reset; 3034 3035 /* we have a reset warning */ 3036 ena_mask &= ~PFINT_OICR_GRST_M; 3037 reset = (rd32(hw, GLGEN_RSTAT) & GLGEN_RSTAT_RESET_TYPE_M) >> 3038 GLGEN_RSTAT_RESET_TYPE_S; 3039 3040 if (reset == ICE_RESET_CORER) 3041 pf->corer_count++; 3042 else if (reset == ICE_RESET_GLOBR) 3043 pf->globr_count++; 3044 else if (reset == ICE_RESET_EMPR) 3045 pf->empr_count++; 3046 else 3047 dev_dbg(dev, "Invalid reset type %d\n", reset); 3048 3049 /* If a reset cycle isn't already in progress, we set a bit in 3050 * pf->state so that the service task can start a reset/rebuild. 3051 */ 3052 if (!test_and_set_bit(ICE_RESET_OICR_RECV, pf->state)) { 3053 if (reset == ICE_RESET_CORER) 3054 set_bit(ICE_CORER_RECV, pf->state); 3055 else if (reset == ICE_RESET_GLOBR) 3056 set_bit(ICE_GLOBR_RECV, pf->state); 3057 else 3058 set_bit(ICE_EMPR_RECV, pf->state); 3059 3060 /* There are couple of different bits at play here. 3061 * hw->reset_ongoing indicates whether the hardware is 3062 * in reset. This is set to true when a reset interrupt 3063 * is received and set back to false after the driver 3064 * has determined that the hardware is out of reset. 3065 * 3066 * ICE_RESET_OICR_RECV in pf->state indicates 3067 * that a post reset rebuild is required before the 3068 * driver is operational again. This is set above. 3069 * 3070 * As this is the start of the reset/rebuild cycle, set 3071 * both to indicate that. 3072 */ 3073 hw->reset_ongoing = true; 3074 } 3075 } 3076 3077 if (oicr & PFINT_OICR_TSYN_TX_M) { 3078 ena_mask &= ~PFINT_OICR_TSYN_TX_M; 3079 ice_ptp_process_ts(pf); 3080 } 3081 3082 if (oicr & PFINT_OICR_TSYN_EVNT_M) { 3083 u8 tmr_idx = hw->func_caps.ts_func_info.tmr_index_owned; 3084 u32 gltsyn_stat = rd32(hw, GLTSYN_STAT(tmr_idx)); 3085 3086 /* Save EVENTs from GTSYN register */ 3087 pf->ptp.ext_ts_irq |= gltsyn_stat & (GLTSYN_STAT_EVENT0_M | 3088 GLTSYN_STAT_EVENT1_M | 3089 GLTSYN_STAT_EVENT2_M); 3090 ena_mask &= ~PFINT_OICR_TSYN_EVNT_M; 3091 kthread_queue_work(pf->ptp.kworker, &pf->ptp.extts_work); 3092 } 3093 3094 #define ICE_AUX_CRIT_ERR (PFINT_OICR_PE_CRITERR_M | PFINT_OICR_HMC_ERR_M | PFINT_OICR_PE_PUSH_M) 3095 if (oicr & ICE_AUX_CRIT_ERR) { 3096 pf->oicr_err_reg |= oicr; 3097 set_bit(ICE_AUX_ERR_PENDING, pf->state); 3098 ena_mask &= ~ICE_AUX_CRIT_ERR; 3099 } 3100 3101 /* Report any remaining unexpected interrupts */ 3102 oicr &= ena_mask; 3103 if (oicr) { 3104 dev_dbg(dev, "unhandled interrupt oicr=0x%08x\n", oicr); 3105 /* If a critical error is pending there is no choice but to 3106 * reset the device. 3107 */ 3108 if (oicr & (PFINT_OICR_PCI_EXCEPTION_M | 3109 PFINT_OICR_ECC_ERR_M)) { 3110 set_bit(ICE_PFR_REQ, pf->state); 3111 ice_service_task_schedule(pf); 3112 } 3113 } 3114 ret = IRQ_HANDLED; 3115 3116 ice_service_task_schedule(pf); 3117 ice_irq_dynamic_ena(hw, NULL, NULL); 3118 3119 return ret; 3120 } 3121 3122 /** 3123 * ice_dis_ctrlq_interrupts - disable control queue interrupts 3124 * @hw: pointer to HW structure 3125 */ 3126 static void ice_dis_ctrlq_interrupts(struct ice_hw *hw) 3127 { 3128 /* disable Admin queue Interrupt causes */ 3129 wr32(hw, PFINT_FW_CTL, 3130 rd32(hw, PFINT_FW_CTL) & ~PFINT_FW_CTL_CAUSE_ENA_M); 3131 3132 /* disable Mailbox queue Interrupt causes */ 3133 wr32(hw, PFINT_MBX_CTL, 3134 rd32(hw, PFINT_MBX_CTL) & ~PFINT_MBX_CTL_CAUSE_ENA_M); 3135 3136 wr32(hw, PFINT_SB_CTL, 3137 rd32(hw, PFINT_SB_CTL) & ~PFINT_SB_CTL_CAUSE_ENA_M); 3138 3139 /* disable Control queue Interrupt causes */ 3140 wr32(hw, PFINT_OICR_CTL, 3141 rd32(hw, PFINT_OICR_CTL) & ~PFINT_OICR_CTL_CAUSE_ENA_M); 3142 3143 ice_flush(hw); 3144 } 3145 3146 /** 3147 * ice_free_irq_msix_misc - Unroll misc vector setup 3148 * @pf: board private structure 3149 */ 3150 static void ice_free_irq_msix_misc(struct ice_pf *pf) 3151 { 3152 struct ice_hw *hw = &pf->hw; 3153 3154 ice_dis_ctrlq_interrupts(hw); 3155 3156 /* disable OICR interrupt */ 3157 wr32(hw, PFINT_OICR_ENA, 0); 3158 ice_flush(hw); 3159 3160 if (pf->msix_entries) { 3161 synchronize_irq(pf->msix_entries[pf->oicr_idx].vector); 3162 devm_free_irq(ice_pf_to_dev(pf), 3163 pf->msix_entries[pf->oicr_idx].vector, pf); 3164 } 3165 3166 pf->num_avail_sw_msix += 1; 3167 ice_free_res(pf->irq_tracker, pf->oicr_idx, ICE_RES_MISC_VEC_ID); 3168 } 3169 3170 /** 3171 * ice_ena_ctrlq_interrupts - enable control queue interrupts 3172 * @hw: pointer to HW structure 3173 * @reg_idx: HW vector index to associate the control queue interrupts with 3174 */ 3175 static void ice_ena_ctrlq_interrupts(struct ice_hw *hw, u16 reg_idx) 3176 { 3177 u32 val; 3178 3179 val = ((reg_idx & PFINT_OICR_CTL_MSIX_INDX_M) | 3180 PFINT_OICR_CTL_CAUSE_ENA_M); 3181 wr32(hw, PFINT_OICR_CTL, val); 3182 3183 /* enable Admin queue Interrupt causes */ 3184 val = ((reg_idx & PFINT_FW_CTL_MSIX_INDX_M) | 3185 PFINT_FW_CTL_CAUSE_ENA_M); 3186 wr32(hw, PFINT_FW_CTL, val); 3187 3188 /* enable Mailbox queue Interrupt causes */ 3189 val = ((reg_idx & PFINT_MBX_CTL_MSIX_INDX_M) | 3190 PFINT_MBX_CTL_CAUSE_ENA_M); 3191 wr32(hw, PFINT_MBX_CTL, val); 3192 3193 /* This enables Sideband queue Interrupt causes */ 3194 val = ((reg_idx & PFINT_SB_CTL_MSIX_INDX_M) | 3195 PFINT_SB_CTL_CAUSE_ENA_M); 3196 wr32(hw, PFINT_SB_CTL, val); 3197 3198 ice_flush(hw); 3199 } 3200 3201 /** 3202 * ice_req_irq_msix_misc - Setup the misc vector to handle non queue events 3203 * @pf: board private structure 3204 * 3205 * This sets up the handler for MSIX 0, which is used to manage the 3206 * non-queue interrupts, e.g. AdminQ and errors. This is not used 3207 * when in MSI or Legacy interrupt mode. 3208 */ 3209 static int ice_req_irq_msix_misc(struct ice_pf *pf) 3210 { 3211 struct device *dev = ice_pf_to_dev(pf); 3212 struct ice_hw *hw = &pf->hw; 3213 int oicr_idx, err = 0; 3214 3215 if (!pf->int_name[0]) 3216 snprintf(pf->int_name, sizeof(pf->int_name) - 1, "%s-%s:misc", 3217 dev_driver_string(dev), dev_name(dev)); 3218 3219 /* Do not request IRQ but do enable OICR interrupt since settings are 3220 * lost during reset. Note that this function is called only during 3221 * rebuild path and not while reset is in progress. 3222 */ 3223 if (ice_is_reset_in_progress(pf->state)) 3224 goto skip_req_irq; 3225 3226 /* reserve one vector in irq_tracker for misc interrupts */ 3227 oicr_idx = ice_get_res(pf, pf->irq_tracker, 1, ICE_RES_MISC_VEC_ID); 3228 if (oicr_idx < 0) 3229 return oicr_idx; 3230 3231 pf->num_avail_sw_msix -= 1; 3232 pf->oicr_idx = (u16)oicr_idx; 3233 3234 err = devm_request_irq(dev, pf->msix_entries[pf->oicr_idx].vector, 3235 ice_misc_intr, 0, pf->int_name, pf); 3236 if (err) { 3237 dev_err(dev, "devm_request_irq for %s failed: %d\n", 3238 pf->int_name, err); 3239 ice_free_res(pf->irq_tracker, 1, ICE_RES_MISC_VEC_ID); 3240 pf->num_avail_sw_msix += 1; 3241 return err; 3242 } 3243 3244 skip_req_irq: 3245 ice_ena_misc_vector(pf); 3246 3247 ice_ena_ctrlq_interrupts(hw, pf->oicr_idx); 3248 wr32(hw, GLINT_ITR(ICE_RX_ITR, pf->oicr_idx), 3249 ITR_REG_ALIGN(ICE_ITR_8K) >> ICE_ITR_GRAN_S); 3250 3251 ice_flush(hw); 3252 ice_irq_dynamic_ena(hw, NULL, NULL); 3253 3254 return 0; 3255 } 3256 3257 /** 3258 * ice_napi_add - register NAPI handler for the VSI 3259 * @vsi: VSI for which NAPI handler is to be registered 3260 * 3261 * This function is only called in the driver's load path. Registering the NAPI 3262 * handler is done in ice_vsi_alloc_q_vector() for all other cases (i.e. resume, 3263 * reset/rebuild, etc.) 3264 */ 3265 static void ice_napi_add(struct ice_vsi *vsi) 3266 { 3267 int v_idx; 3268 3269 if (!vsi->netdev) 3270 return; 3271 3272 ice_for_each_q_vector(vsi, v_idx) 3273 netif_napi_add(vsi->netdev, &vsi->q_vectors[v_idx]->napi, 3274 ice_napi_poll, NAPI_POLL_WEIGHT); 3275 } 3276 3277 /** 3278 * ice_set_ops - set netdev and ethtools ops for the given netdev 3279 * @netdev: netdev instance 3280 */ 3281 static void ice_set_ops(struct net_device *netdev) 3282 { 3283 struct ice_pf *pf = ice_netdev_to_pf(netdev); 3284 3285 if (ice_is_safe_mode(pf)) { 3286 netdev->netdev_ops = &ice_netdev_safe_mode_ops; 3287 ice_set_ethtool_safe_mode_ops(netdev); 3288 return; 3289 } 3290 3291 netdev->netdev_ops = &ice_netdev_ops; 3292 netdev->udp_tunnel_nic_info = &pf->hw.udp_tunnel_nic; 3293 ice_set_ethtool_ops(netdev); 3294 } 3295 3296 /** 3297 * ice_set_netdev_features - set features for the given netdev 3298 * @netdev: netdev instance 3299 */ 3300 static void ice_set_netdev_features(struct net_device *netdev) 3301 { 3302 struct ice_pf *pf = ice_netdev_to_pf(netdev); 3303 bool is_dvm_ena = ice_is_dvm_ena(&pf->hw); 3304 netdev_features_t csumo_features; 3305 netdev_features_t vlano_features; 3306 netdev_features_t dflt_features; 3307 netdev_features_t tso_features; 3308 3309 if (ice_is_safe_mode(pf)) { 3310 /* safe mode */ 3311 netdev->features = NETIF_F_SG | NETIF_F_HIGHDMA; 3312 netdev->hw_features = netdev->features; 3313 return; 3314 } 3315 3316 dflt_features = NETIF_F_SG | 3317 NETIF_F_HIGHDMA | 3318 NETIF_F_NTUPLE | 3319 NETIF_F_RXHASH; 3320 3321 csumo_features = NETIF_F_RXCSUM | 3322 NETIF_F_IP_CSUM | 3323 NETIF_F_SCTP_CRC | 3324 NETIF_F_IPV6_CSUM; 3325 3326 vlano_features = NETIF_F_HW_VLAN_CTAG_FILTER | 3327 NETIF_F_HW_VLAN_CTAG_TX | 3328 NETIF_F_HW_VLAN_CTAG_RX; 3329 3330 /* Enable CTAG/STAG filtering by default in Double VLAN Mode (DVM) */ 3331 if (is_dvm_ena) 3332 vlano_features |= NETIF_F_HW_VLAN_STAG_FILTER; 3333 3334 tso_features = NETIF_F_TSO | 3335 NETIF_F_TSO_ECN | 3336 NETIF_F_TSO6 | 3337 NETIF_F_GSO_GRE | 3338 NETIF_F_GSO_UDP_TUNNEL | 3339 NETIF_F_GSO_GRE_CSUM | 3340 NETIF_F_GSO_UDP_TUNNEL_CSUM | 3341 NETIF_F_GSO_PARTIAL | 3342 NETIF_F_GSO_IPXIP4 | 3343 NETIF_F_GSO_IPXIP6 | 3344 NETIF_F_GSO_UDP_L4; 3345 3346 netdev->gso_partial_features |= NETIF_F_GSO_UDP_TUNNEL_CSUM | 3347 NETIF_F_GSO_GRE_CSUM; 3348 /* set features that user can change */ 3349 netdev->hw_features = dflt_features | csumo_features | 3350 vlano_features | tso_features; 3351 3352 /* add support for HW_CSUM on packets with MPLS header */ 3353 netdev->mpls_features = NETIF_F_HW_CSUM | 3354 NETIF_F_TSO | 3355 NETIF_F_TSO6; 3356 3357 /* enable features */ 3358 netdev->features |= netdev->hw_features; 3359 3360 netdev->hw_features |= NETIF_F_HW_TC; 3361 3362 /* encap and VLAN devices inherit default, csumo and tso features */ 3363 netdev->hw_enc_features |= dflt_features | csumo_features | 3364 tso_features; 3365 netdev->vlan_features |= dflt_features | csumo_features | 3366 tso_features; 3367 3368 /* advertise support but don't enable by default since only one type of 3369 * VLAN offload can be enabled at a time (i.e. CTAG or STAG). When one 3370 * type turns on the other has to be turned off. This is enforced by the 3371 * ice_fix_features() ndo callback. 3372 */ 3373 if (is_dvm_ena) 3374 netdev->hw_features |= NETIF_F_HW_VLAN_STAG_RX | 3375 NETIF_F_HW_VLAN_STAG_TX; 3376 } 3377 3378 /** 3379 * ice_cfg_netdev - Allocate, configure and register a netdev 3380 * @vsi: the VSI associated with the new netdev 3381 * 3382 * Returns 0 on success, negative value on failure 3383 */ 3384 static int ice_cfg_netdev(struct ice_vsi *vsi) 3385 { 3386 struct ice_netdev_priv *np; 3387 struct net_device *netdev; 3388 u8 mac_addr[ETH_ALEN]; 3389 3390 netdev = alloc_etherdev_mqs(sizeof(*np), vsi->alloc_txq, 3391 vsi->alloc_rxq); 3392 if (!netdev) 3393 return -ENOMEM; 3394 3395 set_bit(ICE_VSI_NETDEV_ALLOCD, vsi->state); 3396 vsi->netdev = netdev; 3397 np = netdev_priv(netdev); 3398 np->vsi = vsi; 3399 3400 ice_set_netdev_features(netdev); 3401 3402 ice_set_ops(netdev); 3403 3404 if (vsi->type == ICE_VSI_PF) { 3405 SET_NETDEV_DEV(netdev, ice_pf_to_dev(vsi->back)); 3406 ether_addr_copy(mac_addr, vsi->port_info->mac.perm_addr); 3407 eth_hw_addr_set(netdev, mac_addr); 3408 ether_addr_copy(netdev->perm_addr, mac_addr); 3409 } 3410 3411 netdev->priv_flags |= IFF_UNICAST_FLT; 3412 3413 /* Setup netdev TC information */ 3414 ice_vsi_cfg_netdev_tc(vsi, vsi->tc_cfg.ena_tc); 3415 3416 /* setup watchdog timeout value to be 5 second */ 3417 netdev->watchdog_timeo = 5 * HZ; 3418 3419 netdev->min_mtu = ETH_MIN_MTU; 3420 netdev->max_mtu = ICE_MAX_MTU; 3421 3422 return 0; 3423 } 3424 3425 /** 3426 * ice_fill_rss_lut - Fill the RSS lookup table with default values 3427 * @lut: Lookup table 3428 * @rss_table_size: Lookup table size 3429 * @rss_size: Range of queue number for hashing 3430 */ 3431 void ice_fill_rss_lut(u8 *lut, u16 rss_table_size, u16 rss_size) 3432 { 3433 u16 i; 3434 3435 for (i = 0; i < rss_table_size; i++) 3436 lut[i] = i % rss_size; 3437 } 3438 3439 /** 3440 * ice_pf_vsi_setup - Set up a PF VSI 3441 * @pf: board private structure 3442 * @pi: pointer to the port_info instance 3443 * 3444 * Returns pointer to the successfully allocated VSI software struct 3445 * on success, otherwise returns NULL on failure. 3446 */ 3447 static struct ice_vsi * 3448 ice_pf_vsi_setup(struct ice_pf *pf, struct ice_port_info *pi) 3449 { 3450 return ice_vsi_setup(pf, pi, ICE_VSI_PF, NULL, NULL); 3451 } 3452 3453 static struct ice_vsi * 3454 ice_chnl_vsi_setup(struct ice_pf *pf, struct ice_port_info *pi, 3455 struct ice_channel *ch) 3456 { 3457 return ice_vsi_setup(pf, pi, ICE_VSI_CHNL, NULL, ch); 3458 } 3459 3460 /** 3461 * ice_ctrl_vsi_setup - Set up a control VSI 3462 * @pf: board private structure 3463 * @pi: pointer to the port_info instance 3464 * 3465 * Returns pointer to the successfully allocated VSI software struct 3466 * on success, otherwise returns NULL on failure. 3467 */ 3468 static struct ice_vsi * 3469 ice_ctrl_vsi_setup(struct ice_pf *pf, struct ice_port_info *pi) 3470 { 3471 return ice_vsi_setup(pf, pi, ICE_VSI_CTRL, NULL, NULL); 3472 } 3473 3474 /** 3475 * ice_lb_vsi_setup - Set up a loopback VSI 3476 * @pf: board private structure 3477 * @pi: pointer to the port_info instance 3478 * 3479 * Returns pointer to the successfully allocated VSI software struct 3480 * on success, otherwise returns NULL on failure. 3481 */ 3482 struct ice_vsi * 3483 ice_lb_vsi_setup(struct ice_pf *pf, struct ice_port_info *pi) 3484 { 3485 return ice_vsi_setup(pf, pi, ICE_VSI_LB, NULL, NULL); 3486 } 3487 3488 /** 3489 * ice_vlan_rx_add_vid - Add a VLAN ID filter to HW offload 3490 * @netdev: network interface to be adjusted 3491 * @proto: VLAN TPID 3492 * @vid: VLAN ID to be added 3493 * 3494 * net_device_ops implementation for adding VLAN IDs 3495 */ 3496 static int 3497 ice_vlan_rx_add_vid(struct net_device *netdev, __be16 proto, u16 vid) 3498 { 3499 struct ice_netdev_priv *np = netdev_priv(netdev); 3500 struct ice_vsi_vlan_ops *vlan_ops; 3501 struct ice_vsi *vsi = np->vsi; 3502 struct ice_vlan vlan; 3503 int ret; 3504 3505 /* VLAN 0 is added by default during load/reset */ 3506 if (!vid) 3507 return 0; 3508 3509 while (test_and_set_bit(ICE_CFG_BUSY, vsi->state)) 3510 usleep_range(1000, 2000); 3511 3512 /* Add multicast promisc rule for the VLAN ID to be added if 3513 * all-multicast is currently enabled. 3514 */ 3515 if (vsi->current_netdev_flags & IFF_ALLMULTI) { 3516 ret = ice_fltr_set_vsi_promisc(&vsi->back->hw, vsi->idx, 3517 ICE_MCAST_VLAN_PROMISC_BITS, 3518 vid); 3519 if (ret) 3520 goto finish; 3521 } 3522 3523 vlan_ops = ice_get_compat_vsi_vlan_ops(vsi); 3524 3525 /* Add a switch rule for this VLAN ID so its corresponding VLAN tagged 3526 * packets aren't pruned by the device's internal switch on Rx 3527 */ 3528 vlan = ICE_VLAN(be16_to_cpu(proto), vid, 0); 3529 ret = vlan_ops->add_vlan(vsi, &vlan); 3530 if (ret) 3531 goto finish; 3532 3533 /* If all-multicast is currently enabled and this VLAN ID is only one 3534 * besides VLAN-0 we have to update look-up type of multicast promisc 3535 * rule for VLAN-0 from ICE_SW_LKUP_PROMISC to ICE_SW_LKUP_PROMISC_VLAN. 3536 */ 3537 if ((vsi->current_netdev_flags & IFF_ALLMULTI) && 3538 ice_vsi_num_non_zero_vlans(vsi) == 1) { 3539 ice_fltr_clear_vsi_promisc(&vsi->back->hw, vsi->idx, 3540 ICE_MCAST_PROMISC_BITS, 0); 3541 ice_fltr_set_vsi_promisc(&vsi->back->hw, vsi->idx, 3542 ICE_MCAST_VLAN_PROMISC_BITS, 0); 3543 } 3544 3545 finish: 3546 clear_bit(ICE_CFG_BUSY, vsi->state); 3547 3548 return ret; 3549 } 3550 3551 /** 3552 * ice_vlan_rx_kill_vid - Remove a VLAN ID filter from HW offload 3553 * @netdev: network interface to be adjusted 3554 * @proto: VLAN TPID 3555 * @vid: VLAN ID to be removed 3556 * 3557 * net_device_ops implementation for removing VLAN IDs 3558 */ 3559 static int 3560 ice_vlan_rx_kill_vid(struct net_device *netdev, __be16 proto, u16 vid) 3561 { 3562 struct ice_netdev_priv *np = netdev_priv(netdev); 3563 struct ice_vsi_vlan_ops *vlan_ops; 3564 struct ice_vsi *vsi = np->vsi; 3565 struct ice_vlan vlan; 3566 int ret; 3567 3568 /* don't allow removal of VLAN 0 */ 3569 if (!vid) 3570 return 0; 3571 3572 while (test_and_set_bit(ICE_CFG_BUSY, vsi->state)) 3573 usleep_range(1000, 2000); 3574 3575 vlan_ops = ice_get_compat_vsi_vlan_ops(vsi); 3576 3577 /* Make sure VLAN delete is successful before updating VLAN 3578 * information 3579 */ 3580 vlan = ICE_VLAN(be16_to_cpu(proto), vid, 0); 3581 ret = vlan_ops->del_vlan(vsi, &vlan); 3582 if (ret) 3583 goto finish; 3584 3585 /* Remove multicast promisc rule for the removed VLAN ID if 3586 * all-multicast is enabled. 3587 */ 3588 if (vsi->current_netdev_flags & IFF_ALLMULTI) 3589 ice_fltr_clear_vsi_promisc(&vsi->back->hw, vsi->idx, 3590 ICE_MCAST_VLAN_PROMISC_BITS, vid); 3591 3592 if (!ice_vsi_has_non_zero_vlans(vsi)) { 3593 /* Update look-up type of multicast promisc rule for VLAN 0 3594 * from ICE_SW_LKUP_PROMISC_VLAN to ICE_SW_LKUP_PROMISC when 3595 * all-multicast is enabled and VLAN 0 is the only VLAN rule. 3596 */ 3597 if (vsi->current_netdev_flags & IFF_ALLMULTI) { 3598 ice_fltr_clear_vsi_promisc(&vsi->back->hw, vsi->idx, 3599 ICE_MCAST_VLAN_PROMISC_BITS, 3600 0); 3601 ice_fltr_set_vsi_promisc(&vsi->back->hw, vsi->idx, 3602 ICE_MCAST_PROMISC_BITS, 0); 3603 } 3604 } 3605 3606 finish: 3607 clear_bit(ICE_CFG_BUSY, vsi->state); 3608 3609 return ret; 3610 } 3611 3612 /** 3613 * ice_rep_indr_tc_block_unbind 3614 * @cb_priv: indirection block private data 3615 */ 3616 static void ice_rep_indr_tc_block_unbind(void *cb_priv) 3617 { 3618 struct ice_indr_block_priv *indr_priv = cb_priv; 3619 3620 list_del(&indr_priv->list); 3621 kfree(indr_priv); 3622 } 3623 3624 /** 3625 * ice_tc_indir_block_unregister - Unregister TC indirect block notifications 3626 * @vsi: VSI struct which has the netdev 3627 */ 3628 static void ice_tc_indir_block_unregister(struct ice_vsi *vsi) 3629 { 3630 struct ice_netdev_priv *np = netdev_priv(vsi->netdev); 3631 3632 flow_indr_dev_unregister(ice_indr_setup_tc_cb, np, 3633 ice_rep_indr_tc_block_unbind); 3634 } 3635 3636 /** 3637 * ice_tc_indir_block_remove - clean indirect TC block notifications 3638 * @pf: PF structure 3639 */ 3640 static void ice_tc_indir_block_remove(struct ice_pf *pf) 3641 { 3642 struct ice_vsi *pf_vsi = ice_get_main_vsi(pf); 3643 3644 if (!pf_vsi) 3645 return; 3646 3647 ice_tc_indir_block_unregister(pf_vsi); 3648 } 3649 3650 /** 3651 * ice_tc_indir_block_register - Register TC indirect block notifications 3652 * @vsi: VSI struct which has the netdev 3653 * 3654 * Returns 0 on success, negative value on failure 3655 */ 3656 static int ice_tc_indir_block_register(struct ice_vsi *vsi) 3657 { 3658 struct ice_netdev_priv *np; 3659 3660 if (!vsi || !vsi->netdev) 3661 return -EINVAL; 3662 3663 np = netdev_priv(vsi->netdev); 3664 3665 INIT_LIST_HEAD(&np->tc_indr_block_priv_list); 3666 return flow_indr_dev_register(ice_indr_setup_tc_cb, np); 3667 } 3668 3669 /** 3670 * ice_setup_pf_sw - Setup the HW switch on startup or after reset 3671 * @pf: board private structure 3672 * 3673 * Returns 0 on success, negative value on failure 3674 */ 3675 static int ice_setup_pf_sw(struct ice_pf *pf) 3676 { 3677 struct device *dev = ice_pf_to_dev(pf); 3678 bool dvm = ice_is_dvm_ena(&pf->hw); 3679 struct ice_vsi *vsi; 3680 int status; 3681 3682 if (ice_is_reset_in_progress(pf->state)) 3683 return -EBUSY; 3684 3685 status = ice_aq_set_port_params(pf->hw.port_info, dvm, NULL); 3686 if (status) 3687 return -EIO; 3688 3689 vsi = ice_pf_vsi_setup(pf, pf->hw.port_info); 3690 if (!vsi) 3691 return -ENOMEM; 3692 3693 /* init channel list */ 3694 INIT_LIST_HEAD(&vsi->ch_list); 3695 3696 status = ice_cfg_netdev(vsi); 3697 if (status) 3698 goto unroll_vsi_setup; 3699 /* netdev has to be configured before setting frame size */ 3700 ice_vsi_cfg_frame_size(vsi); 3701 3702 /* init indirect block notifications */ 3703 status = ice_tc_indir_block_register(vsi); 3704 if (status) { 3705 dev_err(dev, "Failed to register netdev notifier\n"); 3706 goto unroll_cfg_netdev; 3707 } 3708 3709 /* Setup DCB netlink interface */ 3710 ice_dcbnl_setup(vsi); 3711 3712 /* registering the NAPI handler requires both the queues and 3713 * netdev to be created, which are done in ice_pf_vsi_setup() 3714 * and ice_cfg_netdev() respectively 3715 */ 3716 ice_napi_add(vsi); 3717 3718 status = ice_init_mac_fltr(pf); 3719 if (status) 3720 goto unroll_napi_add; 3721 3722 return 0; 3723 3724 unroll_napi_add: 3725 ice_tc_indir_block_unregister(vsi); 3726 unroll_cfg_netdev: 3727 if (vsi) { 3728 ice_napi_del(vsi); 3729 if (vsi->netdev) { 3730 clear_bit(ICE_VSI_NETDEV_ALLOCD, vsi->state); 3731 free_netdev(vsi->netdev); 3732 vsi->netdev = NULL; 3733 } 3734 } 3735 3736 unroll_vsi_setup: 3737 ice_vsi_release(vsi); 3738 return status; 3739 } 3740 3741 /** 3742 * ice_get_avail_q_count - Get count of queues in use 3743 * @pf_qmap: bitmap to get queue use count from 3744 * @lock: pointer to a mutex that protects access to pf_qmap 3745 * @size: size of the bitmap 3746 */ 3747 static u16 3748 ice_get_avail_q_count(unsigned long *pf_qmap, struct mutex *lock, u16 size) 3749 { 3750 unsigned long bit; 3751 u16 count = 0; 3752 3753 mutex_lock(lock); 3754 for_each_clear_bit(bit, pf_qmap, size) 3755 count++; 3756 mutex_unlock(lock); 3757 3758 return count; 3759 } 3760 3761 /** 3762 * ice_get_avail_txq_count - Get count of Tx queues in use 3763 * @pf: pointer to an ice_pf instance 3764 */ 3765 u16 ice_get_avail_txq_count(struct ice_pf *pf) 3766 { 3767 return ice_get_avail_q_count(pf->avail_txqs, &pf->avail_q_mutex, 3768 pf->max_pf_txqs); 3769 } 3770 3771 /** 3772 * ice_get_avail_rxq_count - Get count of Rx queues in use 3773 * @pf: pointer to an ice_pf instance 3774 */ 3775 u16 ice_get_avail_rxq_count(struct ice_pf *pf) 3776 { 3777 return ice_get_avail_q_count(pf->avail_rxqs, &pf->avail_q_mutex, 3778 pf->max_pf_rxqs); 3779 } 3780 3781 /** 3782 * ice_deinit_pf - Unrolls initialziations done by ice_init_pf 3783 * @pf: board private structure to initialize 3784 */ 3785 static void ice_deinit_pf(struct ice_pf *pf) 3786 { 3787 ice_service_task_stop(pf); 3788 mutex_destroy(&pf->adev_mutex); 3789 mutex_destroy(&pf->sw_mutex); 3790 mutex_destroy(&pf->tc_mutex); 3791 mutex_destroy(&pf->avail_q_mutex); 3792 mutex_destroy(&pf->vfs.table_lock); 3793 3794 if (pf->avail_txqs) { 3795 bitmap_free(pf->avail_txqs); 3796 pf->avail_txqs = NULL; 3797 } 3798 3799 if (pf->avail_rxqs) { 3800 bitmap_free(pf->avail_rxqs); 3801 pf->avail_rxqs = NULL; 3802 } 3803 3804 if (pf->ptp.clock) 3805 ptp_clock_unregister(pf->ptp.clock); 3806 } 3807 3808 /** 3809 * ice_set_pf_caps - set PFs capability flags 3810 * @pf: pointer to the PF instance 3811 */ 3812 static void ice_set_pf_caps(struct ice_pf *pf) 3813 { 3814 struct ice_hw_func_caps *func_caps = &pf->hw.func_caps; 3815 3816 clear_bit(ICE_FLAG_RDMA_ENA, pf->flags); 3817 if (func_caps->common_cap.rdma) 3818 set_bit(ICE_FLAG_RDMA_ENA, pf->flags); 3819 clear_bit(ICE_FLAG_DCB_CAPABLE, pf->flags); 3820 if (func_caps->common_cap.dcb) 3821 set_bit(ICE_FLAG_DCB_CAPABLE, pf->flags); 3822 clear_bit(ICE_FLAG_SRIOV_CAPABLE, pf->flags); 3823 if (func_caps->common_cap.sr_iov_1_1) { 3824 set_bit(ICE_FLAG_SRIOV_CAPABLE, pf->flags); 3825 pf->vfs.num_supported = min_t(int, func_caps->num_allocd_vfs, 3826 ICE_MAX_SRIOV_VFS); 3827 } 3828 clear_bit(ICE_FLAG_RSS_ENA, pf->flags); 3829 if (func_caps->common_cap.rss_table_size) 3830 set_bit(ICE_FLAG_RSS_ENA, pf->flags); 3831 3832 clear_bit(ICE_FLAG_FD_ENA, pf->flags); 3833 if (func_caps->fd_fltr_guar > 0 || func_caps->fd_fltr_best_effort > 0) { 3834 u16 unused; 3835 3836 /* ctrl_vsi_idx will be set to a valid value when flow director 3837 * is setup by ice_init_fdir 3838 */ 3839 pf->ctrl_vsi_idx = ICE_NO_VSI; 3840 set_bit(ICE_FLAG_FD_ENA, pf->flags); 3841 /* force guaranteed filter pool for PF */ 3842 ice_alloc_fd_guar_item(&pf->hw, &unused, 3843 func_caps->fd_fltr_guar); 3844 /* force shared filter pool for PF */ 3845 ice_alloc_fd_shrd_item(&pf->hw, &unused, 3846 func_caps->fd_fltr_best_effort); 3847 } 3848 3849 clear_bit(ICE_FLAG_PTP_SUPPORTED, pf->flags); 3850 if (func_caps->common_cap.ieee_1588) 3851 set_bit(ICE_FLAG_PTP_SUPPORTED, pf->flags); 3852 3853 pf->max_pf_txqs = func_caps->common_cap.num_txq; 3854 pf->max_pf_rxqs = func_caps->common_cap.num_rxq; 3855 } 3856 3857 /** 3858 * ice_init_pf - Initialize general software structures (struct ice_pf) 3859 * @pf: board private structure to initialize 3860 */ 3861 static int ice_init_pf(struct ice_pf *pf) 3862 { 3863 ice_set_pf_caps(pf); 3864 3865 mutex_init(&pf->sw_mutex); 3866 mutex_init(&pf->tc_mutex); 3867 mutex_init(&pf->adev_mutex); 3868 3869 INIT_HLIST_HEAD(&pf->aq_wait_list); 3870 spin_lock_init(&pf->aq_wait_lock); 3871 init_waitqueue_head(&pf->aq_wait_queue); 3872 3873 init_waitqueue_head(&pf->reset_wait_queue); 3874 3875 /* setup service timer and periodic service task */ 3876 timer_setup(&pf->serv_tmr, ice_service_timer, 0); 3877 pf->serv_tmr_period = HZ; 3878 INIT_WORK(&pf->serv_task, ice_service_task); 3879 clear_bit(ICE_SERVICE_SCHED, pf->state); 3880 3881 mutex_init(&pf->avail_q_mutex); 3882 pf->avail_txqs = bitmap_zalloc(pf->max_pf_txqs, GFP_KERNEL); 3883 if (!pf->avail_txqs) 3884 return -ENOMEM; 3885 3886 pf->avail_rxqs = bitmap_zalloc(pf->max_pf_rxqs, GFP_KERNEL); 3887 if (!pf->avail_rxqs) { 3888 devm_kfree(ice_pf_to_dev(pf), pf->avail_txqs); 3889 pf->avail_txqs = NULL; 3890 return -ENOMEM; 3891 } 3892 3893 mutex_init(&pf->vfs.table_lock); 3894 hash_init(pf->vfs.table); 3895 3896 return 0; 3897 } 3898 3899 /** 3900 * ice_ena_msix_range - Request a range of MSIX vectors from the OS 3901 * @pf: board private structure 3902 * 3903 * compute the number of MSIX vectors required (v_budget) and request from 3904 * the OS. Return the number of vectors reserved or negative on failure 3905 */ 3906 static int ice_ena_msix_range(struct ice_pf *pf) 3907 { 3908 int num_cpus, v_left, v_actual, v_other, v_budget = 0; 3909 struct device *dev = ice_pf_to_dev(pf); 3910 int needed, err, i; 3911 3912 v_left = pf->hw.func_caps.common_cap.num_msix_vectors; 3913 num_cpus = num_online_cpus(); 3914 3915 /* reserve for LAN miscellaneous handler */ 3916 needed = ICE_MIN_LAN_OICR_MSIX; 3917 if (v_left < needed) 3918 goto no_hw_vecs_left_err; 3919 v_budget += needed; 3920 v_left -= needed; 3921 3922 /* reserve for flow director */ 3923 if (test_bit(ICE_FLAG_FD_ENA, pf->flags)) { 3924 needed = ICE_FDIR_MSIX; 3925 if (v_left < needed) 3926 goto no_hw_vecs_left_err; 3927 v_budget += needed; 3928 v_left -= needed; 3929 } 3930 3931 /* reserve for switchdev */ 3932 needed = ICE_ESWITCH_MSIX; 3933 if (v_left < needed) 3934 goto no_hw_vecs_left_err; 3935 v_budget += needed; 3936 v_left -= needed; 3937 3938 /* total used for non-traffic vectors */ 3939 v_other = v_budget; 3940 3941 /* reserve vectors for LAN traffic */ 3942 needed = num_cpus; 3943 if (v_left < needed) 3944 goto no_hw_vecs_left_err; 3945 pf->num_lan_msix = needed; 3946 v_budget += needed; 3947 v_left -= needed; 3948 3949 /* reserve vectors for RDMA auxiliary driver */ 3950 if (ice_is_rdma_ena(pf)) { 3951 needed = num_cpus + ICE_RDMA_NUM_AEQ_MSIX; 3952 if (v_left < needed) 3953 goto no_hw_vecs_left_err; 3954 pf->num_rdma_msix = needed; 3955 v_budget += needed; 3956 v_left -= needed; 3957 } 3958 3959 pf->msix_entries = devm_kcalloc(dev, v_budget, 3960 sizeof(*pf->msix_entries), GFP_KERNEL); 3961 if (!pf->msix_entries) { 3962 err = -ENOMEM; 3963 goto exit_err; 3964 } 3965 3966 for (i = 0; i < v_budget; i++) 3967 pf->msix_entries[i].entry = i; 3968 3969 /* actually reserve the vectors */ 3970 v_actual = pci_enable_msix_range(pf->pdev, pf->msix_entries, 3971 ICE_MIN_MSIX, v_budget); 3972 if (v_actual < 0) { 3973 dev_err(dev, "unable to reserve MSI-X vectors\n"); 3974 err = v_actual; 3975 goto msix_err; 3976 } 3977 3978 if (v_actual < v_budget) { 3979 dev_warn(dev, "not enough OS MSI-X vectors. requested = %d, obtained = %d\n", 3980 v_budget, v_actual); 3981 3982 if (v_actual < ICE_MIN_MSIX) { 3983 /* error if we can't get minimum vectors */ 3984 pci_disable_msix(pf->pdev); 3985 err = -ERANGE; 3986 goto msix_err; 3987 } else { 3988 int v_remain = v_actual - v_other; 3989 int v_rdma = 0, v_min_rdma = 0; 3990 3991 if (ice_is_rdma_ena(pf)) { 3992 /* Need at least 1 interrupt in addition to 3993 * AEQ MSIX 3994 */ 3995 v_rdma = ICE_RDMA_NUM_AEQ_MSIX + 1; 3996 v_min_rdma = ICE_MIN_RDMA_MSIX; 3997 } 3998 3999 if (v_actual == ICE_MIN_MSIX || 4000 v_remain < ICE_MIN_LAN_TXRX_MSIX + v_min_rdma) { 4001 dev_warn(dev, "Not enough MSI-X vectors to support RDMA.\n"); 4002 clear_bit(ICE_FLAG_RDMA_ENA, pf->flags); 4003 4004 pf->num_rdma_msix = 0; 4005 pf->num_lan_msix = ICE_MIN_LAN_TXRX_MSIX; 4006 } else if ((v_remain < ICE_MIN_LAN_TXRX_MSIX + v_rdma) || 4007 (v_remain - v_rdma < v_rdma)) { 4008 /* Support minimum RDMA and give remaining 4009 * vectors to LAN MSIX 4010 */ 4011 pf->num_rdma_msix = v_min_rdma; 4012 pf->num_lan_msix = v_remain - v_min_rdma; 4013 } else { 4014 /* Split remaining MSIX with RDMA after 4015 * accounting for AEQ MSIX 4016 */ 4017 pf->num_rdma_msix = (v_remain - ICE_RDMA_NUM_AEQ_MSIX) / 2 + 4018 ICE_RDMA_NUM_AEQ_MSIX; 4019 pf->num_lan_msix = v_remain - pf->num_rdma_msix; 4020 } 4021 4022 dev_notice(dev, "Enabled %d MSI-X vectors for LAN traffic.\n", 4023 pf->num_lan_msix); 4024 4025 if (ice_is_rdma_ena(pf)) 4026 dev_notice(dev, "Enabled %d MSI-X vectors for RDMA.\n", 4027 pf->num_rdma_msix); 4028 } 4029 } 4030 4031 return v_actual; 4032 4033 msix_err: 4034 devm_kfree(dev, pf->msix_entries); 4035 goto exit_err; 4036 4037 no_hw_vecs_left_err: 4038 dev_err(dev, "not enough device MSI-X vectors. requested = %d, available = %d\n", 4039 needed, v_left); 4040 err = -ERANGE; 4041 exit_err: 4042 pf->num_rdma_msix = 0; 4043 pf->num_lan_msix = 0; 4044 return err; 4045 } 4046 4047 /** 4048 * ice_dis_msix - Disable MSI-X interrupt setup in OS 4049 * @pf: board private structure 4050 */ 4051 static void ice_dis_msix(struct ice_pf *pf) 4052 { 4053 pci_disable_msix(pf->pdev); 4054 devm_kfree(ice_pf_to_dev(pf), pf->msix_entries); 4055 pf->msix_entries = NULL; 4056 } 4057 4058 /** 4059 * ice_clear_interrupt_scheme - Undo things done by ice_init_interrupt_scheme 4060 * @pf: board private structure 4061 */ 4062 static void ice_clear_interrupt_scheme(struct ice_pf *pf) 4063 { 4064 ice_dis_msix(pf); 4065 4066 if (pf->irq_tracker) { 4067 devm_kfree(ice_pf_to_dev(pf), pf->irq_tracker); 4068 pf->irq_tracker = NULL; 4069 } 4070 } 4071 4072 /** 4073 * ice_init_interrupt_scheme - Determine proper interrupt scheme 4074 * @pf: board private structure to initialize 4075 */ 4076 static int ice_init_interrupt_scheme(struct ice_pf *pf) 4077 { 4078 int vectors; 4079 4080 vectors = ice_ena_msix_range(pf); 4081 4082 if (vectors < 0) 4083 return vectors; 4084 4085 /* set up vector assignment tracking */ 4086 pf->irq_tracker = devm_kzalloc(ice_pf_to_dev(pf), 4087 struct_size(pf->irq_tracker, list, vectors), 4088 GFP_KERNEL); 4089 if (!pf->irq_tracker) { 4090 ice_dis_msix(pf); 4091 return -ENOMEM; 4092 } 4093 4094 /* populate SW interrupts pool with number of OS granted IRQs. */ 4095 pf->num_avail_sw_msix = (u16)vectors; 4096 pf->irq_tracker->num_entries = (u16)vectors; 4097 pf->irq_tracker->end = pf->irq_tracker->num_entries; 4098 4099 return 0; 4100 } 4101 4102 /** 4103 * ice_is_wol_supported - check if WoL is supported 4104 * @hw: pointer to hardware info 4105 * 4106 * Check if WoL is supported based on the HW configuration. 4107 * Returns true if NVM supports and enables WoL for this port, false otherwise 4108 */ 4109 bool ice_is_wol_supported(struct ice_hw *hw) 4110 { 4111 u16 wol_ctrl; 4112 4113 /* A bit set to 1 in the NVM Software Reserved Word 2 (WoL control 4114 * word) indicates WoL is not supported on the corresponding PF ID. 4115 */ 4116 if (ice_read_sr_word(hw, ICE_SR_NVM_WOL_CFG, &wol_ctrl)) 4117 return false; 4118 4119 return !(BIT(hw->port_info->lport) & wol_ctrl); 4120 } 4121 4122 /** 4123 * ice_vsi_recfg_qs - Change the number of queues on a VSI 4124 * @vsi: VSI being changed 4125 * @new_rx: new number of Rx queues 4126 * @new_tx: new number of Tx queues 4127 * 4128 * Only change the number of queues if new_tx, or new_rx is non-0. 4129 * 4130 * Returns 0 on success. 4131 */ 4132 int ice_vsi_recfg_qs(struct ice_vsi *vsi, int new_rx, int new_tx) 4133 { 4134 struct ice_pf *pf = vsi->back; 4135 int err = 0, timeout = 50; 4136 4137 if (!new_rx && !new_tx) 4138 return -EINVAL; 4139 4140 while (test_and_set_bit(ICE_CFG_BUSY, pf->state)) { 4141 timeout--; 4142 if (!timeout) 4143 return -EBUSY; 4144 usleep_range(1000, 2000); 4145 } 4146 4147 if (new_tx) 4148 vsi->req_txq = (u16)new_tx; 4149 if (new_rx) 4150 vsi->req_rxq = (u16)new_rx; 4151 4152 /* set for the next time the netdev is started */ 4153 if (!netif_running(vsi->netdev)) { 4154 ice_vsi_rebuild(vsi, false); 4155 dev_dbg(ice_pf_to_dev(pf), "Link is down, queue count change happens when link is brought up\n"); 4156 goto done; 4157 } 4158 4159 ice_vsi_close(vsi); 4160 ice_vsi_rebuild(vsi, false); 4161 ice_pf_dcb_recfg(pf); 4162 ice_vsi_open(vsi); 4163 done: 4164 clear_bit(ICE_CFG_BUSY, pf->state); 4165 return err; 4166 } 4167 4168 /** 4169 * ice_set_safe_mode_vlan_cfg - configure PF VSI to allow all VLANs in safe mode 4170 * @pf: PF to configure 4171 * 4172 * No VLAN offloads/filtering are advertised in safe mode so make sure the PF 4173 * VSI can still Tx/Rx VLAN tagged packets. 4174 */ 4175 static void ice_set_safe_mode_vlan_cfg(struct ice_pf *pf) 4176 { 4177 struct ice_vsi *vsi = ice_get_main_vsi(pf); 4178 struct ice_vsi_ctx *ctxt; 4179 struct ice_hw *hw; 4180 int status; 4181 4182 if (!vsi) 4183 return; 4184 4185 ctxt = kzalloc(sizeof(*ctxt), GFP_KERNEL); 4186 if (!ctxt) 4187 return; 4188 4189 hw = &pf->hw; 4190 ctxt->info = vsi->info; 4191 4192 ctxt->info.valid_sections = 4193 cpu_to_le16(ICE_AQ_VSI_PROP_VLAN_VALID | 4194 ICE_AQ_VSI_PROP_SECURITY_VALID | 4195 ICE_AQ_VSI_PROP_SW_VALID); 4196 4197 /* disable VLAN anti-spoof */ 4198 ctxt->info.sec_flags &= ~(ICE_AQ_VSI_SEC_TX_VLAN_PRUNE_ENA << 4199 ICE_AQ_VSI_SEC_TX_PRUNE_ENA_S); 4200 4201 /* disable VLAN pruning and keep all other settings */ 4202 ctxt->info.sw_flags2 &= ~ICE_AQ_VSI_SW_FLAG_RX_VLAN_PRUNE_ENA; 4203 4204 /* allow all VLANs on Tx and don't strip on Rx */ 4205 ctxt->info.inner_vlan_flags = ICE_AQ_VSI_INNER_VLAN_TX_MODE_ALL | 4206 ICE_AQ_VSI_INNER_VLAN_EMODE_NOTHING; 4207 4208 status = ice_update_vsi(hw, vsi->idx, ctxt, NULL); 4209 if (status) { 4210 dev_err(ice_pf_to_dev(vsi->back), "Failed to update VSI for safe mode VLANs, err %d aq_err %s\n", 4211 status, ice_aq_str(hw->adminq.sq_last_status)); 4212 } else { 4213 vsi->info.sec_flags = ctxt->info.sec_flags; 4214 vsi->info.sw_flags2 = ctxt->info.sw_flags2; 4215 vsi->info.inner_vlan_flags = ctxt->info.inner_vlan_flags; 4216 } 4217 4218 kfree(ctxt); 4219 } 4220 4221 /** 4222 * ice_log_pkg_init - log result of DDP package load 4223 * @hw: pointer to hardware info 4224 * @state: state of package load 4225 */ 4226 static void ice_log_pkg_init(struct ice_hw *hw, enum ice_ddp_state state) 4227 { 4228 struct ice_pf *pf = hw->back; 4229 struct device *dev; 4230 4231 dev = ice_pf_to_dev(pf); 4232 4233 switch (state) { 4234 case ICE_DDP_PKG_SUCCESS: 4235 dev_info(dev, "The DDP package was successfully loaded: %s version %d.%d.%d.%d\n", 4236 hw->active_pkg_name, 4237 hw->active_pkg_ver.major, 4238 hw->active_pkg_ver.minor, 4239 hw->active_pkg_ver.update, 4240 hw->active_pkg_ver.draft); 4241 break; 4242 case ICE_DDP_PKG_SAME_VERSION_ALREADY_LOADED: 4243 dev_info(dev, "DDP package already present on device: %s version %d.%d.%d.%d\n", 4244 hw->active_pkg_name, 4245 hw->active_pkg_ver.major, 4246 hw->active_pkg_ver.minor, 4247 hw->active_pkg_ver.update, 4248 hw->active_pkg_ver.draft); 4249 break; 4250 case ICE_DDP_PKG_ALREADY_LOADED_NOT_SUPPORTED: 4251 dev_err(dev, "The device has a DDP package that is not supported by the driver. The device has package '%s' version %d.%d.x.x. The driver requires version %d.%d.x.x. Entering Safe Mode.\n", 4252 hw->active_pkg_name, 4253 hw->active_pkg_ver.major, 4254 hw->active_pkg_ver.minor, 4255 ICE_PKG_SUPP_VER_MAJ, ICE_PKG_SUPP_VER_MNR); 4256 break; 4257 case ICE_DDP_PKG_COMPATIBLE_ALREADY_LOADED: 4258 dev_info(dev, "The driver could not load the DDP package file because a compatible DDP package is already present on the device. The device has package '%s' version %d.%d.%d.%d. The package file found by the driver: '%s' version %d.%d.%d.%d.\n", 4259 hw->active_pkg_name, 4260 hw->active_pkg_ver.major, 4261 hw->active_pkg_ver.minor, 4262 hw->active_pkg_ver.update, 4263 hw->active_pkg_ver.draft, 4264 hw->pkg_name, 4265 hw->pkg_ver.major, 4266 hw->pkg_ver.minor, 4267 hw->pkg_ver.update, 4268 hw->pkg_ver.draft); 4269 break; 4270 case ICE_DDP_PKG_FW_MISMATCH: 4271 dev_err(dev, "The firmware loaded on the device is not compatible with the DDP package. Please update the device's NVM. Entering safe mode.\n"); 4272 break; 4273 case ICE_DDP_PKG_INVALID_FILE: 4274 dev_err(dev, "The DDP package file is invalid. Entering Safe Mode.\n"); 4275 break; 4276 case ICE_DDP_PKG_FILE_VERSION_TOO_HIGH: 4277 dev_err(dev, "The DDP package file version is higher than the driver supports. Please use an updated driver. Entering Safe Mode.\n"); 4278 break; 4279 case ICE_DDP_PKG_FILE_VERSION_TOO_LOW: 4280 dev_err(dev, "The DDP package file version is lower than the driver supports. The driver requires version %d.%d.x.x. Please use an updated DDP Package file. Entering Safe Mode.\n", 4281 ICE_PKG_SUPP_VER_MAJ, ICE_PKG_SUPP_VER_MNR); 4282 break; 4283 case ICE_DDP_PKG_FILE_SIGNATURE_INVALID: 4284 dev_err(dev, "The DDP package could not be loaded because its signature is not valid. Please use a valid DDP Package. Entering Safe Mode.\n"); 4285 break; 4286 case ICE_DDP_PKG_FILE_REVISION_TOO_LOW: 4287 dev_err(dev, "The DDP Package could not be loaded because its security revision is too low. Please use an updated DDP Package. Entering Safe Mode.\n"); 4288 break; 4289 case ICE_DDP_PKG_LOAD_ERROR: 4290 dev_err(dev, "An error occurred on the device while loading the DDP package. The device will be reset.\n"); 4291 /* poll for reset to complete */ 4292 if (ice_check_reset(hw)) 4293 dev_err(dev, "Error resetting device. Please reload the driver\n"); 4294 break; 4295 case ICE_DDP_PKG_ERR: 4296 default: 4297 dev_err(dev, "An unknown error occurred when loading the DDP package. Entering Safe Mode.\n"); 4298 break; 4299 } 4300 } 4301 4302 /** 4303 * ice_load_pkg - load/reload the DDP Package file 4304 * @firmware: firmware structure when firmware requested or NULL for reload 4305 * @pf: pointer to the PF instance 4306 * 4307 * Called on probe and post CORER/GLOBR rebuild to load DDP Package and 4308 * initialize HW tables. 4309 */ 4310 static void 4311 ice_load_pkg(const struct firmware *firmware, struct ice_pf *pf) 4312 { 4313 enum ice_ddp_state state = ICE_DDP_PKG_ERR; 4314 struct device *dev = ice_pf_to_dev(pf); 4315 struct ice_hw *hw = &pf->hw; 4316 4317 /* Load DDP Package */ 4318 if (firmware && !hw->pkg_copy) { 4319 state = ice_copy_and_init_pkg(hw, firmware->data, 4320 firmware->size); 4321 ice_log_pkg_init(hw, state); 4322 } else if (!firmware && hw->pkg_copy) { 4323 /* Reload package during rebuild after CORER/GLOBR reset */ 4324 state = ice_init_pkg(hw, hw->pkg_copy, hw->pkg_size); 4325 ice_log_pkg_init(hw, state); 4326 } else { 4327 dev_err(dev, "The DDP package file failed to load. Entering Safe Mode.\n"); 4328 } 4329 4330 if (!ice_is_init_pkg_successful(state)) { 4331 /* Safe Mode */ 4332 clear_bit(ICE_FLAG_ADV_FEATURES, pf->flags); 4333 return; 4334 } 4335 4336 /* Successful download package is the precondition for advanced 4337 * features, hence setting the ICE_FLAG_ADV_FEATURES flag 4338 */ 4339 set_bit(ICE_FLAG_ADV_FEATURES, pf->flags); 4340 } 4341 4342 /** 4343 * ice_verify_cacheline_size - verify driver's assumption of 64 Byte cache lines 4344 * @pf: pointer to the PF structure 4345 * 4346 * There is no error returned here because the driver should be able to handle 4347 * 128 Byte cache lines, so we only print a warning in case issues are seen, 4348 * specifically with Tx. 4349 */ 4350 static void ice_verify_cacheline_size(struct ice_pf *pf) 4351 { 4352 if (rd32(&pf->hw, GLPCI_CNF2) & GLPCI_CNF2_CACHELINE_SIZE_M) 4353 dev_warn(ice_pf_to_dev(pf), "%d Byte cache line assumption is invalid, driver may have Tx timeouts!\n", 4354 ICE_CACHE_LINE_BYTES); 4355 } 4356 4357 /** 4358 * ice_send_version - update firmware with driver version 4359 * @pf: PF struct 4360 * 4361 * Returns 0 on success, else error code 4362 */ 4363 static int ice_send_version(struct ice_pf *pf) 4364 { 4365 struct ice_driver_ver dv; 4366 4367 dv.major_ver = 0xff; 4368 dv.minor_ver = 0xff; 4369 dv.build_ver = 0xff; 4370 dv.subbuild_ver = 0; 4371 strscpy((char *)dv.driver_string, UTS_RELEASE, 4372 sizeof(dv.driver_string)); 4373 return ice_aq_send_driver_ver(&pf->hw, &dv, NULL); 4374 } 4375 4376 /** 4377 * ice_init_fdir - Initialize flow director VSI and configuration 4378 * @pf: pointer to the PF instance 4379 * 4380 * returns 0 on success, negative on error 4381 */ 4382 static int ice_init_fdir(struct ice_pf *pf) 4383 { 4384 struct device *dev = ice_pf_to_dev(pf); 4385 struct ice_vsi *ctrl_vsi; 4386 int err; 4387 4388 /* Side Band Flow Director needs to have a control VSI. 4389 * Allocate it and store it in the PF. 4390 */ 4391 ctrl_vsi = ice_ctrl_vsi_setup(pf, pf->hw.port_info); 4392 if (!ctrl_vsi) { 4393 dev_dbg(dev, "could not create control VSI\n"); 4394 return -ENOMEM; 4395 } 4396 4397 err = ice_vsi_open_ctrl(ctrl_vsi); 4398 if (err) { 4399 dev_dbg(dev, "could not open control VSI\n"); 4400 goto err_vsi_open; 4401 } 4402 4403 mutex_init(&pf->hw.fdir_fltr_lock); 4404 4405 err = ice_fdir_create_dflt_rules(pf); 4406 if (err) 4407 goto err_fdir_rule; 4408 4409 return 0; 4410 4411 err_fdir_rule: 4412 ice_fdir_release_flows(&pf->hw); 4413 ice_vsi_close(ctrl_vsi); 4414 err_vsi_open: 4415 ice_vsi_release(ctrl_vsi); 4416 if (pf->ctrl_vsi_idx != ICE_NO_VSI) { 4417 pf->vsi[pf->ctrl_vsi_idx] = NULL; 4418 pf->ctrl_vsi_idx = ICE_NO_VSI; 4419 } 4420 return err; 4421 } 4422 4423 /** 4424 * ice_get_opt_fw_name - return optional firmware file name or NULL 4425 * @pf: pointer to the PF instance 4426 */ 4427 static char *ice_get_opt_fw_name(struct ice_pf *pf) 4428 { 4429 /* Optional firmware name same as default with additional dash 4430 * followed by a EUI-64 identifier (PCIe Device Serial Number) 4431 */ 4432 struct pci_dev *pdev = pf->pdev; 4433 char *opt_fw_filename; 4434 u64 dsn; 4435 4436 /* Determine the name of the optional file using the DSN (two 4437 * dwords following the start of the DSN Capability). 4438 */ 4439 dsn = pci_get_dsn(pdev); 4440 if (!dsn) 4441 return NULL; 4442 4443 opt_fw_filename = kzalloc(NAME_MAX, GFP_KERNEL); 4444 if (!opt_fw_filename) 4445 return NULL; 4446 4447 snprintf(opt_fw_filename, NAME_MAX, "%sice-%016llx.pkg", 4448 ICE_DDP_PKG_PATH, dsn); 4449 4450 return opt_fw_filename; 4451 } 4452 4453 /** 4454 * ice_request_fw - Device initialization routine 4455 * @pf: pointer to the PF instance 4456 */ 4457 static void ice_request_fw(struct ice_pf *pf) 4458 { 4459 char *opt_fw_filename = ice_get_opt_fw_name(pf); 4460 const struct firmware *firmware = NULL; 4461 struct device *dev = ice_pf_to_dev(pf); 4462 int err = 0; 4463 4464 /* optional device-specific DDP (if present) overrides the default DDP 4465 * package file. kernel logs a debug message if the file doesn't exist, 4466 * and warning messages for other errors. 4467 */ 4468 if (opt_fw_filename) { 4469 err = firmware_request_nowarn(&firmware, opt_fw_filename, dev); 4470 if (err) { 4471 kfree(opt_fw_filename); 4472 goto dflt_pkg_load; 4473 } 4474 4475 /* request for firmware was successful. Download to device */ 4476 ice_load_pkg(firmware, pf); 4477 kfree(opt_fw_filename); 4478 release_firmware(firmware); 4479 return; 4480 } 4481 4482 dflt_pkg_load: 4483 err = request_firmware(&firmware, ICE_DDP_PKG_FILE, dev); 4484 if (err) { 4485 dev_err(dev, "The DDP package file was not found or could not be read. Entering Safe Mode\n"); 4486 return; 4487 } 4488 4489 /* request for firmware was successful. Download to device */ 4490 ice_load_pkg(firmware, pf); 4491 release_firmware(firmware); 4492 } 4493 4494 /** 4495 * ice_print_wake_reason - show the wake up cause in the log 4496 * @pf: pointer to the PF struct 4497 */ 4498 static void ice_print_wake_reason(struct ice_pf *pf) 4499 { 4500 u32 wus = pf->wakeup_reason; 4501 const char *wake_str; 4502 4503 /* if no wake event, nothing to print */ 4504 if (!wus) 4505 return; 4506 4507 if (wus & PFPM_WUS_LNKC_M) 4508 wake_str = "Link\n"; 4509 else if (wus & PFPM_WUS_MAG_M) 4510 wake_str = "Magic Packet\n"; 4511 else if (wus & PFPM_WUS_MNG_M) 4512 wake_str = "Management\n"; 4513 else if (wus & PFPM_WUS_FW_RST_WK_M) 4514 wake_str = "Firmware Reset\n"; 4515 else 4516 wake_str = "Unknown\n"; 4517 4518 dev_info(ice_pf_to_dev(pf), "Wake reason: %s", wake_str); 4519 } 4520 4521 /** 4522 * ice_register_netdev - register netdev and devlink port 4523 * @pf: pointer to the PF struct 4524 */ 4525 static int ice_register_netdev(struct ice_pf *pf) 4526 { 4527 struct ice_vsi *vsi; 4528 int err = 0; 4529 4530 vsi = ice_get_main_vsi(pf); 4531 if (!vsi || !vsi->netdev) 4532 return -EIO; 4533 4534 err = register_netdev(vsi->netdev); 4535 if (err) 4536 goto err_register_netdev; 4537 4538 set_bit(ICE_VSI_NETDEV_REGISTERED, vsi->state); 4539 netif_carrier_off(vsi->netdev); 4540 netif_tx_stop_all_queues(vsi->netdev); 4541 err = ice_devlink_create_pf_port(pf); 4542 if (err) 4543 goto err_devlink_create; 4544 4545 devlink_port_type_eth_set(&pf->devlink_port, vsi->netdev); 4546 4547 return 0; 4548 err_devlink_create: 4549 unregister_netdev(vsi->netdev); 4550 clear_bit(ICE_VSI_NETDEV_REGISTERED, vsi->state); 4551 err_register_netdev: 4552 free_netdev(vsi->netdev); 4553 vsi->netdev = NULL; 4554 clear_bit(ICE_VSI_NETDEV_ALLOCD, vsi->state); 4555 return err; 4556 } 4557 4558 /** 4559 * ice_probe - Device initialization routine 4560 * @pdev: PCI device information struct 4561 * @ent: entry in ice_pci_tbl 4562 * 4563 * Returns 0 on success, negative on failure 4564 */ 4565 static int 4566 ice_probe(struct pci_dev *pdev, const struct pci_device_id __always_unused *ent) 4567 { 4568 struct device *dev = &pdev->dev; 4569 struct ice_pf *pf; 4570 struct ice_hw *hw; 4571 int i, err; 4572 4573 if (pdev->is_virtfn) { 4574 dev_err(dev, "can't probe a virtual function\n"); 4575 return -EINVAL; 4576 } 4577 4578 /* this driver uses devres, see 4579 * Documentation/driver-api/driver-model/devres.rst 4580 */ 4581 err = pcim_enable_device(pdev); 4582 if (err) 4583 return err; 4584 4585 err = pcim_iomap_regions(pdev, BIT(ICE_BAR0), dev_driver_string(dev)); 4586 if (err) { 4587 dev_err(dev, "BAR0 I/O map error %d\n", err); 4588 return err; 4589 } 4590 4591 pf = ice_allocate_pf(dev); 4592 if (!pf) 4593 return -ENOMEM; 4594 4595 /* initialize Auxiliary index to invalid value */ 4596 pf->aux_idx = -1; 4597 4598 /* set up for high or low DMA */ 4599 err = dma_set_mask_and_coherent(dev, DMA_BIT_MASK(64)); 4600 if (err) { 4601 dev_err(dev, "DMA configuration failed: 0x%x\n", err); 4602 return err; 4603 } 4604 4605 pci_enable_pcie_error_reporting(pdev); 4606 pci_set_master(pdev); 4607 4608 pf->pdev = pdev; 4609 pci_set_drvdata(pdev, pf); 4610 set_bit(ICE_DOWN, pf->state); 4611 /* Disable service task until DOWN bit is cleared */ 4612 set_bit(ICE_SERVICE_DIS, pf->state); 4613 4614 hw = &pf->hw; 4615 hw->hw_addr = pcim_iomap_table(pdev)[ICE_BAR0]; 4616 pci_save_state(pdev); 4617 4618 hw->back = pf; 4619 hw->vendor_id = pdev->vendor; 4620 hw->device_id = pdev->device; 4621 pci_read_config_byte(pdev, PCI_REVISION_ID, &hw->revision_id); 4622 hw->subsystem_vendor_id = pdev->subsystem_vendor; 4623 hw->subsystem_device_id = pdev->subsystem_device; 4624 hw->bus.device = PCI_SLOT(pdev->devfn); 4625 hw->bus.func = PCI_FUNC(pdev->devfn); 4626 ice_set_ctrlq_len(hw); 4627 4628 pf->msg_enable = netif_msg_init(debug, ICE_DFLT_NETIF_M); 4629 4630 #ifndef CONFIG_DYNAMIC_DEBUG 4631 if (debug < -1) 4632 hw->debug_mask = debug; 4633 #endif 4634 4635 err = ice_init_hw(hw); 4636 if (err) { 4637 dev_err(dev, "ice_init_hw failed: %d\n", err); 4638 err = -EIO; 4639 goto err_exit_unroll; 4640 } 4641 4642 ice_init_feature_support(pf); 4643 4644 ice_request_fw(pf); 4645 4646 /* if ice_request_fw fails, ICE_FLAG_ADV_FEATURES bit won't be 4647 * set in pf->state, which will cause ice_is_safe_mode to return 4648 * true 4649 */ 4650 if (ice_is_safe_mode(pf)) { 4651 /* we already got function/device capabilities but these don't 4652 * reflect what the driver needs to do in safe mode. Instead of 4653 * adding conditional logic everywhere to ignore these 4654 * device/function capabilities, override them. 4655 */ 4656 ice_set_safe_mode_caps(hw); 4657 } 4658 4659 hw->ucast_shared = true; 4660 4661 err = ice_init_pf(pf); 4662 if (err) { 4663 dev_err(dev, "ice_init_pf failed: %d\n", err); 4664 goto err_init_pf_unroll; 4665 } 4666 4667 ice_devlink_init_regions(pf); 4668 4669 pf->hw.udp_tunnel_nic.set_port = ice_udp_tunnel_set_port; 4670 pf->hw.udp_tunnel_nic.unset_port = ice_udp_tunnel_unset_port; 4671 pf->hw.udp_tunnel_nic.flags = UDP_TUNNEL_NIC_INFO_MAY_SLEEP; 4672 pf->hw.udp_tunnel_nic.shared = &pf->hw.udp_tunnel_shared; 4673 i = 0; 4674 if (pf->hw.tnl.valid_count[TNL_VXLAN]) { 4675 pf->hw.udp_tunnel_nic.tables[i].n_entries = 4676 pf->hw.tnl.valid_count[TNL_VXLAN]; 4677 pf->hw.udp_tunnel_nic.tables[i].tunnel_types = 4678 UDP_TUNNEL_TYPE_VXLAN; 4679 i++; 4680 } 4681 if (pf->hw.tnl.valid_count[TNL_GENEVE]) { 4682 pf->hw.udp_tunnel_nic.tables[i].n_entries = 4683 pf->hw.tnl.valid_count[TNL_GENEVE]; 4684 pf->hw.udp_tunnel_nic.tables[i].tunnel_types = 4685 UDP_TUNNEL_TYPE_GENEVE; 4686 i++; 4687 } 4688 4689 pf->num_alloc_vsi = hw->func_caps.guar_num_vsi; 4690 if (!pf->num_alloc_vsi) { 4691 err = -EIO; 4692 goto err_init_pf_unroll; 4693 } 4694 if (pf->num_alloc_vsi > UDP_TUNNEL_NIC_MAX_SHARING_DEVICES) { 4695 dev_warn(&pf->pdev->dev, 4696 "limiting the VSI count due to UDP tunnel limitation %d > %d\n", 4697 pf->num_alloc_vsi, UDP_TUNNEL_NIC_MAX_SHARING_DEVICES); 4698 pf->num_alloc_vsi = UDP_TUNNEL_NIC_MAX_SHARING_DEVICES; 4699 } 4700 4701 pf->vsi = devm_kcalloc(dev, pf->num_alloc_vsi, sizeof(*pf->vsi), 4702 GFP_KERNEL); 4703 if (!pf->vsi) { 4704 err = -ENOMEM; 4705 goto err_init_pf_unroll; 4706 } 4707 4708 err = ice_init_interrupt_scheme(pf); 4709 if (err) { 4710 dev_err(dev, "ice_init_interrupt_scheme failed: %d\n", err); 4711 err = -EIO; 4712 goto err_init_vsi_unroll; 4713 } 4714 4715 /* In case of MSIX we are going to setup the misc vector right here 4716 * to handle admin queue events etc. In case of legacy and MSI 4717 * the misc functionality and queue processing is combined in 4718 * the same vector and that gets setup at open. 4719 */ 4720 err = ice_req_irq_msix_misc(pf); 4721 if (err) { 4722 dev_err(dev, "setup of misc vector failed: %d\n", err); 4723 goto err_init_interrupt_unroll; 4724 } 4725 4726 /* create switch struct for the switch element created by FW on boot */ 4727 pf->first_sw = devm_kzalloc(dev, sizeof(*pf->first_sw), GFP_KERNEL); 4728 if (!pf->first_sw) { 4729 err = -ENOMEM; 4730 goto err_msix_misc_unroll; 4731 } 4732 4733 if (hw->evb_veb) 4734 pf->first_sw->bridge_mode = BRIDGE_MODE_VEB; 4735 else 4736 pf->first_sw->bridge_mode = BRIDGE_MODE_VEPA; 4737 4738 pf->first_sw->pf = pf; 4739 4740 /* record the sw_id available for later use */ 4741 pf->first_sw->sw_id = hw->port_info->sw_id; 4742 4743 err = ice_setup_pf_sw(pf); 4744 if (err) { 4745 dev_err(dev, "probe failed due to setup PF switch: %d\n", err); 4746 goto err_alloc_sw_unroll; 4747 } 4748 4749 clear_bit(ICE_SERVICE_DIS, pf->state); 4750 4751 /* tell the firmware we are up */ 4752 err = ice_send_version(pf); 4753 if (err) { 4754 dev_err(dev, "probe failed sending driver version %s. error: %d\n", 4755 UTS_RELEASE, err); 4756 goto err_send_version_unroll; 4757 } 4758 4759 /* since everything is good, start the service timer */ 4760 mod_timer(&pf->serv_tmr, round_jiffies(jiffies + pf->serv_tmr_period)); 4761 4762 err = ice_init_link_events(pf->hw.port_info); 4763 if (err) { 4764 dev_err(dev, "ice_init_link_events failed: %d\n", err); 4765 goto err_send_version_unroll; 4766 } 4767 4768 /* not a fatal error if this fails */ 4769 err = ice_init_nvm_phy_type(pf->hw.port_info); 4770 if (err) 4771 dev_err(dev, "ice_init_nvm_phy_type failed: %d\n", err); 4772 4773 /* not a fatal error if this fails */ 4774 err = ice_update_link_info(pf->hw.port_info); 4775 if (err) 4776 dev_err(dev, "ice_update_link_info failed: %d\n", err); 4777 4778 ice_init_link_dflt_override(pf->hw.port_info); 4779 4780 ice_check_link_cfg_err(pf, 4781 pf->hw.port_info->phy.link_info.link_cfg_err); 4782 4783 /* if media available, initialize PHY settings */ 4784 if (pf->hw.port_info->phy.link_info.link_info & 4785 ICE_AQ_MEDIA_AVAILABLE) { 4786 /* not a fatal error if this fails */ 4787 err = ice_init_phy_user_cfg(pf->hw.port_info); 4788 if (err) 4789 dev_err(dev, "ice_init_phy_user_cfg failed: %d\n", err); 4790 4791 if (!test_bit(ICE_FLAG_LINK_DOWN_ON_CLOSE_ENA, pf->flags)) { 4792 struct ice_vsi *vsi = ice_get_main_vsi(pf); 4793 4794 if (vsi) 4795 ice_configure_phy(vsi); 4796 } 4797 } else { 4798 set_bit(ICE_FLAG_NO_MEDIA, pf->flags); 4799 } 4800 4801 ice_verify_cacheline_size(pf); 4802 4803 /* Save wakeup reason register for later use */ 4804 pf->wakeup_reason = rd32(hw, PFPM_WUS); 4805 4806 /* check for a power management event */ 4807 ice_print_wake_reason(pf); 4808 4809 /* clear wake status, all bits */ 4810 wr32(hw, PFPM_WUS, U32_MAX); 4811 4812 /* Disable WoL at init, wait for user to enable */ 4813 device_set_wakeup_enable(dev, false); 4814 4815 if (ice_is_safe_mode(pf)) { 4816 ice_set_safe_mode_vlan_cfg(pf); 4817 goto probe_done; 4818 } 4819 4820 /* initialize DDP driven features */ 4821 if (test_bit(ICE_FLAG_PTP_SUPPORTED, pf->flags)) 4822 ice_ptp_init(pf); 4823 4824 if (ice_is_feature_supported(pf, ICE_F_GNSS)) 4825 ice_gnss_init(pf); 4826 4827 /* Note: Flow director init failure is non-fatal to load */ 4828 if (ice_init_fdir(pf)) 4829 dev_err(dev, "could not initialize flow director\n"); 4830 4831 /* Note: DCB init failure is non-fatal to load */ 4832 if (ice_init_pf_dcb(pf, false)) { 4833 clear_bit(ICE_FLAG_DCB_CAPABLE, pf->flags); 4834 clear_bit(ICE_FLAG_DCB_ENA, pf->flags); 4835 } else { 4836 ice_cfg_lldp_mib_change(&pf->hw, true); 4837 } 4838 4839 if (ice_init_lag(pf)) 4840 dev_warn(dev, "Failed to init link aggregation support\n"); 4841 4842 /* print PCI link speed and width */ 4843 pcie_print_link_status(pf->pdev); 4844 4845 probe_done: 4846 err = ice_register_netdev(pf); 4847 if (err) 4848 goto err_netdev_reg; 4849 4850 err = ice_devlink_register_params(pf); 4851 if (err) 4852 goto err_netdev_reg; 4853 4854 /* ready to go, so clear down state bit */ 4855 clear_bit(ICE_DOWN, pf->state); 4856 if (ice_is_rdma_ena(pf)) { 4857 pf->aux_idx = ida_alloc(&ice_aux_ida, GFP_KERNEL); 4858 if (pf->aux_idx < 0) { 4859 dev_err(dev, "Failed to allocate device ID for AUX driver\n"); 4860 err = -ENOMEM; 4861 goto err_devlink_reg_param; 4862 } 4863 4864 err = ice_init_rdma(pf); 4865 if (err) { 4866 dev_err(dev, "Failed to initialize RDMA: %d\n", err); 4867 err = -EIO; 4868 goto err_init_aux_unroll; 4869 } 4870 } else { 4871 dev_warn(dev, "RDMA is not supported on this device\n"); 4872 } 4873 4874 ice_devlink_register(pf); 4875 return 0; 4876 4877 err_init_aux_unroll: 4878 pf->adev = NULL; 4879 ida_free(&ice_aux_ida, pf->aux_idx); 4880 err_devlink_reg_param: 4881 ice_devlink_unregister_params(pf); 4882 err_netdev_reg: 4883 err_send_version_unroll: 4884 ice_vsi_release_all(pf); 4885 err_alloc_sw_unroll: 4886 set_bit(ICE_SERVICE_DIS, pf->state); 4887 set_bit(ICE_DOWN, pf->state); 4888 devm_kfree(dev, pf->first_sw); 4889 err_msix_misc_unroll: 4890 ice_free_irq_msix_misc(pf); 4891 err_init_interrupt_unroll: 4892 ice_clear_interrupt_scheme(pf); 4893 err_init_vsi_unroll: 4894 devm_kfree(dev, pf->vsi); 4895 err_init_pf_unroll: 4896 ice_deinit_pf(pf); 4897 ice_devlink_destroy_regions(pf); 4898 ice_deinit_hw(hw); 4899 err_exit_unroll: 4900 pci_disable_pcie_error_reporting(pdev); 4901 pci_disable_device(pdev); 4902 return err; 4903 } 4904 4905 /** 4906 * ice_set_wake - enable or disable Wake on LAN 4907 * @pf: pointer to the PF struct 4908 * 4909 * Simple helper for WoL control 4910 */ 4911 static void ice_set_wake(struct ice_pf *pf) 4912 { 4913 struct ice_hw *hw = &pf->hw; 4914 bool wol = pf->wol_ena; 4915 4916 /* clear wake state, otherwise new wake events won't fire */ 4917 wr32(hw, PFPM_WUS, U32_MAX); 4918 4919 /* enable / disable APM wake up, no RMW needed */ 4920 wr32(hw, PFPM_APM, wol ? PFPM_APM_APME_M : 0); 4921 4922 /* set magic packet filter enabled */ 4923 wr32(hw, PFPM_WUFC, wol ? PFPM_WUFC_MAG_M : 0); 4924 } 4925 4926 /** 4927 * ice_setup_mc_magic_wake - setup device to wake on multicast magic packet 4928 * @pf: pointer to the PF struct 4929 * 4930 * Issue firmware command to enable multicast magic wake, making 4931 * sure that any locally administered address (LAA) is used for 4932 * wake, and that PF reset doesn't undo the LAA. 4933 */ 4934 static void ice_setup_mc_magic_wake(struct ice_pf *pf) 4935 { 4936 struct device *dev = ice_pf_to_dev(pf); 4937 struct ice_hw *hw = &pf->hw; 4938 u8 mac_addr[ETH_ALEN]; 4939 struct ice_vsi *vsi; 4940 int status; 4941 u8 flags; 4942 4943 if (!pf->wol_ena) 4944 return; 4945 4946 vsi = ice_get_main_vsi(pf); 4947 if (!vsi) 4948 return; 4949 4950 /* Get current MAC address in case it's an LAA */ 4951 if (vsi->netdev) 4952 ether_addr_copy(mac_addr, vsi->netdev->dev_addr); 4953 else 4954 ether_addr_copy(mac_addr, vsi->port_info->mac.perm_addr); 4955 4956 flags = ICE_AQC_MAN_MAC_WR_MC_MAG_EN | 4957 ICE_AQC_MAN_MAC_UPDATE_LAA_WOL | 4958 ICE_AQC_MAN_MAC_WR_WOL_LAA_PFR_KEEP; 4959 4960 status = ice_aq_manage_mac_write(hw, mac_addr, flags, NULL); 4961 if (status) 4962 dev_err(dev, "Failed to enable Multicast Magic Packet wake, err %d aq_err %s\n", 4963 status, ice_aq_str(hw->adminq.sq_last_status)); 4964 } 4965 4966 /** 4967 * ice_remove - Device removal routine 4968 * @pdev: PCI device information struct 4969 */ 4970 static void ice_remove(struct pci_dev *pdev) 4971 { 4972 struct ice_pf *pf = pci_get_drvdata(pdev); 4973 int i; 4974 4975 ice_devlink_unregister(pf); 4976 for (i = 0; i < ICE_MAX_RESET_WAIT; i++) { 4977 if (!ice_is_reset_in_progress(pf->state)) 4978 break; 4979 msleep(100); 4980 } 4981 4982 ice_tc_indir_block_remove(pf); 4983 4984 if (test_bit(ICE_FLAG_SRIOV_ENA, pf->flags)) { 4985 set_bit(ICE_VF_RESETS_DISABLED, pf->state); 4986 ice_free_vfs(pf); 4987 } 4988 4989 ice_service_task_stop(pf); 4990 4991 ice_aq_cancel_waiting_tasks(pf); 4992 ice_unplug_aux_dev(pf); 4993 if (pf->aux_idx >= 0) 4994 ida_free(&ice_aux_ida, pf->aux_idx); 4995 ice_devlink_unregister_params(pf); 4996 set_bit(ICE_DOWN, pf->state); 4997 4998 ice_deinit_lag(pf); 4999 if (test_bit(ICE_FLAG_PTP_SUPPORTED, pf->flags)) 5000 ice_ptp_release(pf); 5001 if (ice_is_feature_supported(pf, ICE_F_GNSS)) 5002 ice_gnss_exit(pf); 5003 if (!ice_is_safe_mode(pf)) 5004 ice_remove_arfs(pf); 5005 ice_setup_mc_magic_wake(pf); 5006 ice_vsi_release_all(pf); 5007 mutex_destroy(&(&pf->hw)->fdir_fltr_lock); 5008 ice_set_wake(pf); 5009 ice_free_irq_msix_misc(pf); 5010 ice_for_each_vsi(pf, i) { 5011 if (!pf->vsi[i]) 5012 continue; 5013 ice_vsi_free_q_vectors(pf->vsi[i]); 5014 } 5015 ice_deinit_pf(pf); 5016 ice_devlink_destroy_regions(pf); 5017 ice_deinit_hw(&pf->hw); 5018 5019 /* Issue a PFR as part of the prescribed driver unload flow. Do not 5020 * do it via ice_schedule_reset() since there is no need to rebuild 5021 * and the service task is already stopped. 5022 */ 5023 ice_reset(&pf->hw, ICE_RESET_PFR); 5024 pci_wait_for_pending_transaction(pdev); 5025 ice_clear_interrupt_scheme(pf); 5026 pci_disable_pcie_error_reporting(pdev); 5027 pci_disable_device(pdev); 5028 } 5029 5030 /** 5031 * ice_shutdown - PCI callback for shutting down device 5032 * @pdev: PCI device information struct 5033 */ 5034 static void ice_shutdown(struct pci_dev *pdev) 5035 { 5036 struct ice_pf *pf = pci_get_drvdata(pdev); 5037 5038 ice_remove(pdev); 5039 5040 if (system_state == SYSTEM_POWER_OFF) { 5041 pci_wake_from_d3(pdev, pf->wol_ena); 5042 pci_set_power_state(pdev, PCI_D3hot); 5043 } 5044 } 5045 5046 #ifdef CONFIG_PM 5047 /** 5048 * ice_prepare_for_shutdown - prep for PCI shutdown 5049 * @pf: board private structure 5050 * 5051 * Inform or close all dependent features in prep for PCI device shutdown 5052 */ 5053 static void ice_prepare_for_shutdown(struct ice_pf *pf) 5054 { 5055 struct ice_hw *hw = &pf->hw; 5056 u32 v; 5057 5058 /* Notify VFs of impending reset */ 5059 if (ice_check_sq_alive(hw, &hw->mailboxq)) 5060 ice_vc_notify_reset(pf); 5061 5062 dev_dbg(ice_pf_to_dev(pf), "Tearing down internal switch for shutdown\n"); 5063 5064 /* disable the VSIs and their queues that are not already DOWN */ 5065 ice_pf_dis_all_vsi(pf, false); 5066 5067 ice_for_each_vsi(pf, v) 5068 if (pf->vsi[v]) 5069 pf->vsi[v]->vsi_num = 0; 5070 5071 ice_shutdown_all_ctrlq(hw); 5072 } 5073 5074 /** 5075 * ice_reinit_interrupt_scheme - Reinitialize interrupt scheme 5076 * @pf: board private structure to reinitialize 5077 * 5078 * This routine reinitialize interrupt scheme that was cleared during 5079 * power management suspend callback. 5080 * 5081 * This should be called during resume routine to re-allocate the q_vectors 5082 * and reacquire interrupts. 5083 */ 5084 static int ice_reinit_interrupt_scheme(struct ice_pf *pf) 5085 { 5086 struct device *dev = ice_pf_to_dev(pf); 5087 int ret, v; 5088 5089 /* Since we clear MSIX flag during suspend, we need to 5090 * set it back during resume... 5091 */ 5092 5093 ret = ice_init_interrupt_scheme(pf); 5094 if (ret) { 5095 dev_err(dev, "Failed to re-initialize interrupt %d\n", ret); 5096 return ret; 5097 } 5098 5099 /* Remap vectors and rings, after successful re-init interrupts */ 5100 ice_for_each_vsi(pf, v) { 5101 if (!pf->vsi[v]) 5102 continue; 5103 5104 ret = ice_vsi_alloc_q_vectors(pf->vsi[v]); 5105 if (ret) 5106 goto err_reinit; 5107 ice_vsi_map_rings_to_vectors(pf->vsi[v]); 5108 } 5109 5110 ret = ice_req_irq_msix_misc(pf); 5111 if (ret) { 5112 dev_err(dev, "Setting up misc vector failed after device suspend %d\n", 5113 ret); 5114 goto err_reinit; 5115 } 5116 5117 return 0; 5118 5119 err_reinit: 5120 while (v--) 5121 if (pf->vsi[v]) 5122 ice_vsi_free_q_vectors(pf->vsi[v]); 5123 5124 return ret; 5125 } 5126 5127 /** 5128 * ice_suspend 5129 * @dev: generic device information structure 5130 * 5131 * Power Management callback to quiesce the device and prepare 5132 * for D3 transition. 5133 */ 5134 static int __maybe_unused ice_suspend(struct device *dev) 5135 { 5136 struct pci_dev *pdev = to_pci_dev(dev); 5137 struct ice_pf *pf; 5138 int disabled, v; 5139 5140 pf = pci_get_drvdata(pdev); 5141 5142 if (!ice_pf_state_is_nominal(pf)) { 5143 dev_err(dev, "Device is not ready, no need to suspend it\n"); 5144 return -EBUSY; 5145 } 5146 5147 /* Stop watchdog tasks until resume completion. 5148 * Even though it is most likely that the service task is 5149 * disabled if the device is suspended or down, the service task's 5150 * state is controlled by a different state bit, and we should 5151 * store and honor whatever state that bit is in at this point. 5152 */ 5153 disabled = ice_service_task_stop(pf); 5154 5155 ice_unplug_aux_dev(pf); 5156 5157 /* Already suspended?, then there is nothing to do */ 5158 if (test_and_set_bit(ICE_SUSPENDED, pf->state)) { 5159 if (!disabled) 5160 ice_service_task_restart(pf); 5161 return 0; 5162 } 5163 5164 if (test_bit(ICE_DOWN, pf->state) || 5165 ice_is_reset_in_progress(pf->state)) { 5166 dev_err(dev, "can't suspend device in reset or already down\n"); 5167 if (!disabled) 5168 ice_service_task_restart(pf); 5169 return 0; 5170 } 5171 5172 ice_setup_mc_magic_wake(pf); 5173 5174 ice_prepare_for_shutdown(pf); 5175 5176 ice_set_wake(pf); 5177 5178 /* Free vectors, clear the interrupt scheme and release IRQs 5179 * for proper hibernation, especially with large number of CPUs. 5180 * Otherwise hibernation might fail when mapping all the vectors back 5181 * to CPU0. 5182 */ 5183 ice_free_irq_msix_misc(pf); 5184 ice_for_each_vsi(pf, v) { 5185 if (!pf->vsi[v]) 5186 continue; 5187 ice_vsi_free_q_vectors(pf->vsi[v]); 5188 } 5189 ice_clear_interrupt_scheme(pf); 5190 5191 pci_save_state(pdev); 5192 pci_wake_from_d3(pdev, pf->wol_ena); 5193 pci_set_power_state(pdev, PCI_D3hot); 5194 return 0; 5195 } 5196 5197 /** 5198 * ice_resume - PM callback for waking up from D3 5199 * @dev: generic device information structure 5200 */ 5201 static int __maybe_unused ice_resume(struct device *dev) 5202 { 5203 struct pci_dev *pdev = to_pci_dev(dev); 5204 enum ice_reset_req reset_type; 5205 struct ice_pf *pf; 5206 struct ice_hw *hw; 5207 int ret; 5208 5209 pci_set_power_state(pdev, PCI_D0); 5210 pci_restore_state(pdev); 5211 pci_save_state(pdev); 5212 5213 if (!pci_device_is_present(pdev)) 5214 return -ENODEV; 5215 5216 ret = pci_enable_device_mem(pdev); 5217 if (ret) { 5218 dev_err(dev, "Cannot enable device after suspend\n"); 5219 return ret; 5220 } 5221 5222 pf = pci_get_drvdata(pdev); 5223 hw = &pf->hw; 5224 5225 pf->wakeup_reason = rd32(hw, PFPM_WUS); 5226 ice_print_wake_reason(pf); 5227 5228 /* We cleared the interrupt scheme when we suspended, so we need to 5229 * restore it now to resume device functionality. 5230 */ 5231 ret = ice_reinit_interrupt_scheme(pf); 5232 if (ret) 5233 dev_err(dev, "Cannot restore interrupt scheme: %d\n", ret); 5234 5235 clear_bit(ICE_DOWN, pf->state); 5236 /* Now perform PF reset and rebuild */ 5237 reset_type = ICE_RESET_PFR; 5238 /* re-enable service task for reset, but allow reset to schedule it */ 5239 clear_bit(ICE_SERVICE_DIS, pf->state); 5240 5241 if (ice_schedule_reset(pf, reset_type)) 5242 dev_err(dev, "Reset during resume failed.\n"); 5243 5244 clear_bit(ICE_SUSPENDED, pf->state); 5245 ice_service_task_restart(pf); 5246 5247 /* Restart the service task */ 5248 mod_timer(&pf->serv_tmr, round_jiffies(jiffies + pf->serv_tmr_period)); 5249 5250 return 0; 5251 } 5252 #endif /* CONFIG_PM */ 5253 5254 /** 5255 * ice_pci_err_detected - warning that PCI error has been detected 5256 * @pdev: PCI device information struct 5257 * @err: the type of PCI error 5258 * 5259 * Called to warn that something happened on the PCI bus and the error handling 5260 * is in progress. Allows the driver to gracefully prepare/handle PCI errors. 5261 */ 5262 static pci_ers_result_t 5263 ice_pci_err_detected(struct pci_dev *pdev, pci_channel_state_t err) 5264 { 5265 struct ice_pf *pf = pci_get_drvdata(pdev); 5266 5267 if (!pf) { 5268 dev_err(&pdev->dev, "%s: unrecoverable device error %d\n", 5269 __func__, err); 5270 return PCI_ERS_RESULT_DISCONNECT; 5271 } 5272 5273 if (!test_bit(ICE_SUSPENDED, pf->state)) { 5274 ice_service_task_stop(pf); 5275 5276 if (!test_bit(ICE_PREPARED_FOR_RESET, pf->state)) { 5277 set_bit(ICE_PFR_REQ, pf->state); 5278 ice_prepare_for_reset(pf, ICE_RESET_PFR); 5279 } 5280 } 5281 5282 return PCI_ERS_RESULT_NEED_RESET; 5283 } 5284 5285 /** 5286 * ice_pci_err_slot_reset - a PCI slot reset has just happened 5287 * @pdev: PCI device information struct 5288 * 5289 * Called to determine if the driver can recover from the PCI slot reset by 5290 * using a register read to determine if the device is recoverable. 5291 */ 5292 static pci_ers_result_t ice_pci_err_slot_reset(struct pci_dev *pdev) 5293 { 5294 struct ice_pf *pf = pci_get_drvdata(pdev); 5295 pci_ers_result_t result; 5296 int err; 5297 u32 reg; 5298 5299 err = pci_enable_device_mem(pdev); 5300 if (err) { 5301 dev_err(&pdev->dev, "Cannot re-enable PCI device after reset, error %d\n", 5302 err); 5303 result = PCI_ERS_RESULT_DISCONNECT; 5304 } else { 5305 pci_set_master(pdev); 5306 pci_restore_state(pdev); 5307 pci_save_state(pdev); 5308 pci_wake_from_d3(pdev, false); 5309 5310 /* Check for life */ 5311 reg = rd32(&pf->hw, GLGEN_RTRIG); 5312 if (!reg) 5313 result = PCI_ERS_RESULT_RECOVERED; 5314 else 5315 result = PCI_ERS_RESULT_DISCONNECT; 5316 } 5317 5318 return result; 5319 } 5320 5321 /** 5322 * ice_pci_err_resume - restart operations after PCI error recovery 5323 * @pdev: PCI device information struct 5324 * 5325 * Called to allow the driver to bring things back up after PCI error and/or 5326 * reset recovery have finished 5327 */ 5328 static void ice_pci_err_resume(struct pci_dev *pdev) 5329 { 5330 struct ice_pf *pf = pci_get_drvdata(pdev); 5331 5332 if (!pf) { 5333 dev_err(&pdev->dev, "%s failed, device is unrecoverable\n", 5334 __func__); 5335 return; 5336 } 5337 5338 if (test_bit(ICE_SUSPENDED, pf->state)) { 5339 dev_dbg(&pdev->dev, "%s failed to resume normal operations!\n", 5340 __func__); 5341 return; 5342 } 5343 5344 ice_restore_all_vfs_msi_state(pdev); 5345 5346 ice_do_reset(pf, ICE_RESET_PFR); 5347 ice_service_task_restart(pf); 5348 mod_timer(&pf->serv_tmr, round_jiffies(jiffies + pf->serv_tmr_period)); 5349 } 5350 5351 /** 5352 * ice_pci_err_reset_prepare - prepare device driver for PCI reset 5353 * @pdev: PCI device information struct 5354 */ 5355 static void ice_pci_err_reset_prepare(struct pci_dev *pdev) 5356 { 5357 struct ice_pf *pf = pci_get_drvdata(pdev); 5358 5359 if (!test_bit(ICE_SUSPENDED, pf->state)) { 5360 ice_service_task_stop(pf); 5361 5362 if (!test_bit(ICE_PREPARED_FOR_RESET, pf->state)) { 5363 set_bit(ICE_PFR_REQ, pf->state); 5364 ice_prepare_for_reset(pf, ICE_RESET_PFR); 5365 } 5366 } 5367 } 5368 5369 /** 5370 * ice_pci_err_reset_done - PCI reset done, device driver reset can begin 5371 * @pdev: PCI device information struct 5372 */ 5373 static void ice_pci_err_reset_done(struct pci_dev *pdev) 5374 { 5375 ice_pci_err_resume(pdev); 5376 } 5377 5378 /* ice_pci_tbl - PCI Device ID Table 5379 * 5380 * Wildcard entries (PCI_ANY_ID) should come last 5381 * Last entry must be all 0s 5382 * 5383 * { Vendor ID, Device ID, SubVendor ID, SubDevice ID, 5384 * Class, Class Mask, private data (not used) } 5385 */ 5386 static const struct pci_device_id ice_pci_tbl[] = { 5387 { PCI_VDEVICE(INTEL, ICE_DEV_ID_E810C_BACKPLANE), 0 }, 5388 { PCI_VDEVICE(INTEL, ICE_DEV_ID_E810C_QSFP), 0 }, 5389 { PCI_VDEVICE(INTEL, ICE_DEV_ID_E810C_SFP), 0 }, 5390 { PCI_VDEVICE(INTEL, ICE_DEV_ID_E810_XXV_BACKPLANE), 0 }, 5391 { PCI_VDEVICE(INTEL, ICE_DEV_ID_E810_XXV_QSFP), 0 }, 5392 { PCI_VDEVICE(INTEL, ICE_DEV_ID_E810_XXV_SFP), 0 }, 5393 { PCI_VDEVICE(INTEL, ICE_DEV_ID_E823C_BACKPLANE), 0 }, 5394 { PCI_VDEVICE(INTEL, ICE_DEV_ID_E823C_QSFP), 0 }, 5395 { PCI_VDEVICE(INTEL, ICE_DEV_ID_E823C_SFP), 0 }, 5396 { PCI_VDEVICE(INTEL, ICE_DEV_ID_E823C_10G_BASE_T), 0 }, 5397 { PCI_VDEVICE(INTEL, ICE_DEV_ID_E823C_SGMII), 0 }, 5398 { PCI_VDEVICE(INTEL, ICE_DEV_ID_E822C_BACKPLANE), 0 }, 5399 { PCI_VDEVICE(INTEL, ICE_DEV_ID_E822C_QSFP), 0 }, 5400 { PCI_VDEVICE(INTEL, ICE_DEV_ID_E822C_SFP), 0 }, 5401 { PCI_VDEVICE(INTEL, ICE_DEV_ID_E822C_10G_BASE_T), 0 }, 5402 { PCI_VDEVICE(INTEL, ICE_DEV_ID_E822C_SGMII), 0 }, 5403 { PCI_VDEVICE(INTEL, ICE_DEV_ID_E822L_BACKPLANE), 0 }, 5404 { PCI_VDEVICE(INTEL, ICE_DEV_ID_E822L_SFP), 0 }, 5405 { PCI_VDEVICE(INTEL, ICE_DEV_ID_E822L_10G_BASE_T), 0 }, 5406 { PCI_VDEVICE(INTEL, ICE_DEV_ID_E822L_SGMII), 0 }, 5407 { PCI_VDEVICE(INTEL, ICE_DEV_ID_E823L_BACKPLANE), 0 }, 5408 { PCI_VDEVICE(INTEL, ICE_DEV_ID_E823L_SFP), 0 }, 5409 { PCI_VDEVICE(INTEL, ICE_DEV_ID_E823L_10G_BASE_T), 0 }, 5410 { PCI_VDEVICE(INTEL, ICE_DEV_ID_E823L_1GBE), 0 }, 5411 { PCI_VDEVICE(INTEL, ICE_DEV_ID_E823L_QSFP), 0 }, 5412 { PCI_VDEVICE(INTEL, ICE_DEV_ID_E822_SI_DFLT), 0 }, 5413 /* required last entry */ 5414 { 0, } 5415 }; 5416 MODULE_DEVICE_TABLE(pci, ice_pci_tbl); 5417 5418 static __maybe_unused SIMPLE_DEV_PM_OPS(ice_pm_ops, ice_suspend, ice_resume); 5419 5420 static const struct pci_error_handlers ice_pci_err_handler = { 5421 .error_detected = ice_pci_err_detected, 5422 .slot_reset = ice_pci_err_slot_reset, 5423 .reset_prepare = ice_pci_err_reset_prepare, 5424 .reset_done = ice_pci_err_reset_done, 5425 .resume = ice_pci_err_resume 5426 }; 5427 5428 static struct pci_driver ice_driver = { 5429 .name = KBUILD_MODNAME, 5430 .id_table = ice_pci_tbl, 5431 .probe = ice_probe, 5432 .remove = ice_remove, 5433 #ifdef CONFIG_PM 5434 .driver.pm = &ice_pm_ops, 5435 #endif /* CONFIG_PM */ 5436 .shutdown = ice_shutdown, 5437 .sriov_configure = ice_sriov_configure, 5438 .err_handler = &ice_pci_err_handler 5439 }; 5440 5441 /** 5442 * ice_module_init - Driver registration routine 5443 * 5444 * ice_module_init is the first routine called when the driver is 5445 * loaded. All it does is register with the PCI subsystem. 5446 */ 5447 static int __init ice_module_init(void) 5448 { 5449 int status; 5450 5451 pr_info("%s\n", ice_driver_string); 5452 pr_info("%s\n", ice_copyright); 5453 5454 ice_wq = alloc_workqueue("%s", WQ_MEM_RECLAIM, 0, KBUILD_MODNAME); 5455 if (!ice_wq) { 5456 pr_err("Failed to create workqueue\n"); 5457 return -ENOMEM; 5458 } 5459 5460 status = pci_register_driver(&ice_driver); 5461 if (status) { 5462 pr_err("failed to register PCI driver, err %d\n", status); 5463 destroy_workqueue(ice_wq); 5464 } 5465 5466 return status; 5467 } 5468 module_init(ice_module_init); 5469 5470 /** 5471 * ice_module_exit - Driver exit cleanup routine 5472 * 5473 * ice_module_exit is called just before the driver is removed 5474 * from memory. 5475 */ 5476 static void __exit ice_module_exit(void) 5477 { 5478 pci_unregister_driver(&ice_driver); 5479 destroy_workqueue(ice_wq); 5480 pr_info("module unloaded\n"); 5481 } 5482 module_exit(ice_module_exit); 5483 5484 /** 5485 * ice_set_mac_address - NDO callback to set MAC address 5486 * @netdev: network interface device structure 5487 * @pi: pointer to an address structure 5488 * 5489 * Returns 0 on success, negative on failure 5490 */ 5491 static int ice_set_mac_address(struct net_device *netdev, void *pi) 5492 { 5493 struct ice_netdev_priv *np = netdev_priv(netdev); 5494 struct ice_vsi *vsi = np->vsi; 5495 struct ice_pf *pf = vsi->back; 5496 struct ice_hw *hw = &pf->hw; 5497 struct sockaddr *addr = pi; 5498 u8 old_mac[ETH_ALEN]; 5499 u8 flags = 0; 5500 u8 *mac; 5501 int err; 5502 5503 mac = (u8 *)addr->sa_data; 5504 5505 if (!is_valid_ether_addr(mac)) 5506 return -EADDRNOTAVAIL; 5507 5508 if (ether_addr_equal(netdev->dev_addr, mac)) { 5509 netdev_dbg(netdev, "already using mac %pM\n", mac); 5510 return 0; 5511 } 5512 5513 if (test_bit(ICE_DOWN, pf->state) || 5514 ice_is_reset_in_progress(pf->state)) { 5515 netdev_err(netdev, "can't set mac %pM. device not ready\n", 5516 mac); 5517 return -EBUSY; 5518 } 5519 5520 if (ice_chnl_dmac_fltr_cnt(pf)) { 5521 netdev_err(netdev, "can't set mac %pM. Device has tc-flower filters, delete all of them and try again\n", 5522 mac); 5523 return -EAGAIN; 5524 } 5525 5526 netif_addr_lock_bh(netdev); 5527 ether_addr_copy(old_mac, netdev->dev_addr); 5528 /* change the netdev's MAC address */ 5529 eth_hw_addr_set(netdev, mac); 5530 netif_addr_unlock_bh(netdev); 5531 5532 /* Clean up old MAC filter. Not an error if old filter doesn't exist */ 5533 err = ice_fltr_remove_mac(vsi, old_mac, ICE_FWD_TO_VSI); 5534 if (err && err != -ENOENT) { 5535 err = -EADDRNOTAVAIL; 5536 goto err_update_filters; 5537 } 5538 5539 /* Add filter for new MAC. If filter exists, return success */ 5540 err = ice_fltr_add_mac(vsi, mac, ICE_FWD_TO_VSI); 5541 if (err == -EEXIST) { 5542 /* Although this MAC filter is already present in hardware it's 5543 * possible in some cases (e.g. bonding) that dev_addr was 5544 * modified outside of the driver and needs to be restored back 5545 * to this value. 5546 */ 5547 netdev_dbg(netdev, "filter for MAC %pM already exists\n", mac); 5548 5549 return 0; 5550 } else if (err) { 5551 /* error if the new filter addition failed */ 5552 err = -EADDRNOTAVAIL; 5553 } 5554 5555 err_update_filters: 5556 if (err) { 5557 netdev_err(netdev, "can't set MAC %pM. filter update failed\n", 5558 mac); 5559 netif_addr_lock_bh(netdev); 5560 eth_hw_addr_set(netdev, old_mac); 5561 netif_addr_unlock_bh(netdev); 5562 return err; 5563 } 5564 5565 netdev_dbg(vsi->netdev, "updated MAC address to %pM\n", 5566 netdev->dev_addr); 5567 5568 /* write new MAC address to the firmware */ 5569 flags = ICE_AQC_MAN_MAC_UPDATE_LAA_WOL; 5570 err = ice_aq_manage_mac_write(hw, mac, flags, NULL); 5571 if (err) { 5572 netdev_err(netdev, "can't set MAC %pM. write to firmware failed error %d\n", 5573 mac, err); 5574 } 5575 return 0; 5576 } 5577 5578 /** 5579 * ice_set_rx_mode - NDO callback to set the netdev filters 5580 * @netdev: network interface device structure 5581 */ 5582 static void ice_set_rx_mode(struct net_device *netdev) 5583 { 5584 struct ice_netdev_priv *np = netdev_priv(netdev); 5585 struct ice_vsi *vsi = np->vsi; 5586 5587 if (!vsi) 5588 return; 5589 5590 /* Set the flags to synchronize filters 5591 * ndo_set_rx_mode may be triggered even without a change in netdev 5592 * flags 5593 */ 5594 set_bit(ICE_VSI_UMAC_FLTR_CHANGED, vsi->state); 5595 set_bit(ICE_VSI_MMAC_FLTR_CHANGED, vsi->state); 5596 set_bit(ICE_FLAG_FLTR_SYNC, vsi->back->flags); 5597 5598 /* schedule our worker thread which will take care of 5599 * applying the new filter changes 5600 */ 5601 ice_service_task_schedule(vsi->back); 5602 } 5603 5604 /** 5605 * ice_set_tx_maxrate - NDO callback to set the maximum per-queue bitrate 5606 * @netdev: network interface device structure 5607 * @queue_index: Queue ID 5608 * @maxrate: maximum bandwidth in Mbps 5609 */ 5610 static int 5611 ice_set_tx_maxrate(struct net_device *netdev, int queue_index, u32 maxrate) 5612 { 5613 struct ice_netdev_priv *np = netdev_priv(netdev); 5614 struct ice_vsi *vsi = np->vsi; 5615 u16 q_handle; 5616 int status; 5617 u8 tc; 5618 5619 /* Validate maxrate requested is within permitted range */ 5620 if (maxrate && (maxrate > (ICE_SCHED_MAX_BW / 1000))) { 5621 netdev_err(netdev, "Invalid max rate %d specified for the queue %d\n", 5622 maxrate, queue_index); 5623 return -EINVAL; 5624 } 5625 5626 q_handle = vsi->tx_rings[queue_index]->q_handle; 5627 tc = ice_dcb_get_tc(vsi, queue_index); 5628 5629 /* Set BW back to default, when user set maxrate to 0 */ 5630 if (!maxrate) 5631 status = ice_cfg_q_bw_dflt_lmt(vsi->port_info, vsi->idx, tc, 5632 q_handle, ICE_MAX_BW); 5633 else 5634 status = ice_cfg_q_bw_lmt(vsi->port_info, vsi->idx, tc, 5635 q_handle, ICE_MAX_BW, maxrate * 1000); 5636 if (status) 5637 netdev_err(netdev, "Unable to set Tx max rate, error %d\n", 5638 status); 5639 5640 return status; 5641 } 5642 5643 /** 5644 * ice_fdb_add - add an entry to the hardware database 5645 * @ndm: the input from the stack 5646 * @tb: pointer to array of nladdr (unused) 5647 * @dev: the net device pointer 5648 * @addr: the MAC address entry being added 5649 * @vid: VLAN ID 5650 * @flags: instructions from stack about fdb operation 5651 * @extack: netlink extended ack 5652 */ 5653 static int 5654 ice_fdb_add(struct ndmsg *ndm, struct nlattr __always_unused *tb[], 5655 struct net_device *dev, const unsigned char *addr, u16 vid, 5656 u16 flags, struct netlink_ext_ack __always_unused *extack) 5657 { 5658 int err; 5659 5660 if (vid) { 5661 netdev_err(dev, "VLANs aren't supported yet for dev_uc|mc_add()\n"); 5662 return -EINVAL; 5663 } 5664 if (ndm->ndm_state && !(ndm->ndm_state & NUD_PERMANENT)) { 5665 netdev_err(dev, "FDB only supports static addresses\n"); 5666 return -EINVAL; 5667 } 5668 5669 if (is_unicast_ether_addr(addr) || is_link_local_ether_addr(addr)) 5670 err = dev_uc_add_excl(dev, addr); 5671 else if (is_multicast_ether_addr(addr)) 5672 err = dev_mc_add_excl(dev, addr); 5673 else 5674 err = -EINVAL; 5675 5676 /* Only return duplicate errors if NLM_F_EXCL is set */ 5677 if (err == -EEXIST && !(flags & NLM_F_EXCL)) 5678 err = 0; 5679 5680 return err; 5681 } 5682 5683 /** 5684 * ice_fdb_del - delete an entry from the hardware database 5685 * @ndm: the input from the stack 5686 * @tb: pointer to array of nladdr (unused) 5687 * @dev: the net device pointer 5688 * @addr: the MAC address entry being added 5689 * @vid: VLAN ID 5690 * @extack: netlink extended ack 5691 */ 5692 static int 5693 ice_fdb_del(struct ndmsg *ndm, __always_unused struct nlattr *tb[], 5694 struct net_device *dev, const unsigned char *addr, 5695 __always_unused u16 vid, struct netlink_ext_ack *extack) 5696 { 5697 int err; 5698 5699 if (ndm->ndm_state & NUD_PERMANENT) { 5700 netdev_err(dev, "FDB only supports static addresses\n"); 5701 return -EINVAL; 5702 } 5703 5704 if (is_unicast_ether_addr(addr)) 5705 err = dev_uc_del(dev, addr); 5706 else if (is_multicast_ether_addr(addr)) 5707 err = dev_mc_del(dev, addr); 5708 else 5709 err = -EINVAL; 5710 5711 return err; 5712 } 5713 5714 #define NETIF_VLAN_OFFLOAD_FEATURES (NETIF_F_HW_VLAN_CTAG_RX | \ 5715 NETIF_F_HW_VLAN_CTAG_TX | \ 5716 NETIF_F_HW_VLAN_STAG_RX | \ 5717 NETIF_F_HW_VLAN_STAG_TX) 5718 5719 #define NETIF_VLAN_FILTERING_FEATURES (NETIF_F_HW_VLAN_CTAG_FILTER | \ 5720 NETIF_F_HW_VLAN_STAG_FILTER) 5721 5722 /** 5723 * ice_fix_features - fix the netdev features flags based on device limitations 5724 * @netdev: ptr to the netdev that flags are being fixed on 5725 * @features: features that need to be checked and possibly fixed 5726 * 5727 * Make sure any fixups are made to features in this callback. This enables the 5728 * driver to not have to check unsupported configurations throughout the driver 5729 * because that's the responsiblity of this callback. 5730 * 5731 * Single VLAN Mode (SVM) Supported Features: 5732 * NETIF_F_HW_VLAN_CTAG_FILTER 5733 * NETIF_F_HW_VLAN_CTAG_RX 5734 * NETIF_F_HW_VLAN_CTAG_TX 5735 * 5736 * Double VLAN Mode (DVM) Supported Features: 5737 * NETIF_F_HW_VLAN_CTAG_FILTER 5738 * NETIF_F_HW_VLAN_CTAG_RX 5739 * NETIF_F_HW_VLAN_CTAG_TX 5740 * 5741 * NETIF_F_HW_VLAN_STAG_FILTER 5742 * NETIF_HW_VLAN_STAG_RX 5743 * NETIF_HW_VLAN_STAG_TX 5744 * 5745 * Features that need fixing: 5746 * Cannot simultaneously enable CTAG and STAG stripping and/or insertion. 5747 * These are mutually exlusive as the VSI context cannot support multiple 5748 * VLAN ethertypes simultaneously for stripping and/or insertion. If this 5749 * is not done, then default to clearing the requested STAG offload 5750 * settings. 5751 * 5752 * All supported filtering has to be enabled or disabled together. For 5753 * example, in DVM, CTAG and STAG filtering have to be enabled and disabled 5754 * together. If this is not done, then default to VLAN filtering disabled. 5755 * These are mutually exclusive as there is currently no way to 5756 * enable/disable VLAN filtering based on VLAN ethertype when using VLAN 5757 * prune rules. 5758 */ 5759 static netdev_features_t 5760 ice_fix_features(struct net_device *netdev, netdev_features_t features) 5761 { 5762 struct ice_netdev_priv *np = netdev_priv(netdev); 5763 netdev_features_t req_vlan_fltr, cur_vlan_fltr; 5764 bool cur_ctag, cur_stag, req_ctag, req_stag; 5765 5766 cur_vlan_fltr = netdev->features & NETIF_VLAN_FILTERING_FEATURES; 5767 cur_ctag = cur_vlan_fltr & NETIF_F_HW_VLAN_CTAG_FILTER; 5768 cur_stag = cur_vlan_fltr & NETIF_F_HW_VLAN_STAG_FILTER; 5769 5770 req_vlan_fltr = features & NETIF_VLAN_FILTERING_FEATURES; 5771 req_ctag = req_vlan_fltr & NETIF_F_HW_VLAN_CTAG_FILTER; 5772 req_stag = req_vlan_fltr & NETIF_F_HW_VLAN_STAG_FILTER; 5773 5774 if (req_vlan_fltr != cur_vlan_fltr) { 5775 if (ice_is_dvm_ena(&np->vsi->back->hw)) { 5776 if (req_ctag && req_stag) { 5777 features |= NETIF_VLAN_FILTERING_FEATURES; 5778 } else if (!req_ctag && !req_stag) { 5779 features &= ~NETIF_VLAN_FILTERING_FEATURES; 5780 } else if ((!cur_ctag && req_ctag && !cur_stag) || 5781 (!cur_stag && req_stag && !cur_ctag)) { 5782 features |= NETIF_VLAN_FILTERING_FEATURES; 5783 netdev_warn(netdev, "802.1Q and 802.1ad VLAN filtering must be either both on or both off. VLAN filtering has been enabled for both types.\n"); 5784 } else if ((cur_ctag && !req_ctag && cur_stag) || 5785 (cur_stag && !req_stag && cur_ctag)) { 5786 features &= ~NETIF_VLAN_FILTERING_FEATURES; 5787 netdev_warn(netdev, "802.1Q and 802.1ad VLAN filtering must be either both on or both off. VLAN filtering has been disabled for both types.\n"); 5788 } 5789 } else { 5790 if (req_vlan_fltr & NETIF_F_HW_VLAN_STAG_FILTER) 5791 netdev_warn(netdev, "cannot support requested 802.1ad filtering setting in SVM mode\n"); 5792 5793 if (req_vlan_fltr & NETIF_F_HW_VLAN_CTAG_FILTER) 5794 features |= NETIF_F_HW_VLAN_CTAG_FILTER; 5795 } 5796 } 5797 5798 if ((features & (NETIF_F_HW_VLAN_CTAG_RX | NETIF_F_HW_VLAN_CTAG_TX)) && 5799 (features & (NETIF_F_HW_VLAN_STAG_RX | NETIF_F_HW_VLAN_STAG_TX))) { 5800 netdev_warn(netdev, "cannot support CTAG and STAG VLAN stripping and/or insertion simultaneously since CTAG and STAG offloads are mutually exclusive, clearing STAG offload settings\n"); 5801 features &= ~(NETIF_F_HW_VLAN_STAG_RX | 5802 NETIF_F_HW_VLAN_STAG_TX); 5803 } 5804 5805 return features; 5806 } 5807 5808 /** 5809 * ice_set_vlan_offload_features - set VLAN offload features for the PF VSI 5810 * @vsi: PF's VSI 5811 * @features: features used to determine VLAN offload settings 5812 * 5813 * First, determine the vlan_ethertype based on the VLAN offload bits in 5814 * features. Then determine if stripping and insertion should be enabled or 5815 * disabled. Finally enable or disable VLAN stripping and insertion. 5816 */ 5817 static int 5818 ice_set_vlan_offload_features(struct ice_vsi *vsi, netdev_features_t features) 5819 { 5820 bool enable_stripping = true, enable_insertion = true; 5821 struct ice_vsi_vlan_ops *vlan_ops; 5822 int strip_err = 0, insert_err = 0; 5823 u16 vlan_ethertype = 0; 5824 5825 vlan_ops = ice_get_compat_vsi_vlan_ops(vsi); 5826 5827 if (features & (NETIF_F_HW_VLAN_STAG_RX | NETIF_F_HW_VLAN_STAG_TX)) 5828 vlan_ethertype = ETH_P_8021AD; 5829 else if (features & (NETIF_F_HW_VLAN_CTAG_RX | NETIF_F_HW_VLAN_CTAG_TX)) 5830 vlan_ethertype = ETH_P_8021Q; 5831 5832 if (!(features & (NETIF_F_HW_VLAN_STAG_RX | NETIF_F_HW_VLAN_CTAG_RX))) 5833 enable_stripping = false; 5834 if (!(features & (NETIF_F_HW_VLAN_STAG_TX | NETIF_F_HW_VLAN_CTAG_TX))) 5835 enable_insertion = false; 5836 5837 if (enable_stripping) 5838 strip_err = vlan_ops->ena_stripping(vsi, vlan_ethertype); 5839 else 5840 strip_err = vlan_ops->dis_stripping(vsi); 5841 5842 if (enable_insertion) 5843 insert_err = vlan_ops->ena_insertion(vsi, vlan_ethertype); 5844 else 5845 insert_err = vlan_ops->dis_insertion(vsi); 5846 5847 if (strip_err || insert_err) 5848 return -EIO; 5849 5850 return 0; 5851 } 5852 5853 /** 5854 * ice_set_vlan_filtering_features - set VLAN filtering features for the PF VSI 5855 * @vsi: PF's VSI 5856 * @features: features used to determine VLAN filtering settings 5857 * 5858 * Enable or disable Rx VLAN filtering based on the VLAN filtering bits in the 5859 * features. 5860 */ 5861 static int 5862 ice_set_vlan_filtering_features(struct ice_vsi *vsi, netdev_features_t features) 5863 { 5864 struct ice_vsi_vlan_ops *vlan_ops = ice_get_compat_vsi_vlan_ops(vsi); 5865 int err = 0; 5866 5867 /* support Single VLAN Mode (SVM) and Double VLAN Mode (DVM) by checking 5868 * if either bit is set 5869 */ 5870 if (features & 5871 (NETIF_F_HW_VLAN_CTAG_FILTER | NETIF_F_HW_VLAN_STAG_FILTER)) 5872 err = vlan_ops->ena_rx_filtering(vsi); 5873 else 5874 err = vlan_ops->dis_rx_filtering(vsi); 5875 5876 return err; 5877 } 5878 5879 /** 5880 * ice_set_vlan_features - set VLAN settings based on suggested feature set 5881 * @netdev: ptr to the netdev being adjusted 5882 * @features: the feature set that the stack is suggesting 5883 * 5884 * Only update VLAN settings if the requested_vlan_features are different than 5885 * the current_vlan_features. 5886 */ 5887 static int 5888 ice_set_vlan_features(struct net_device *netdev, netdev_features_t features) 5889 { 5890 netdev_features_t current_vlan_features, requested_vlan_features; 5891 struct ice_netdev_priv *np = netdev_priv(netdev); 5892 struct ice_vsi *vsi = np->vsi; 5893 int err; 5894 5895 current_vlan_features = netdev->features & NETIF_VLAN_OFFLOAD_FEATURES; 5896 requested_vlan_features = features & NETIF_VLAN_OFFLOAD_FEATURES; 5897 if (current_vlan_features ^ requested_vlan_features) { 5898 err = ice_set_vlan_offload_features(vsi, features); 5899 if (err) 5900 return err; 5901 } 5902 5903 current_vlan_features = netdev->features & 5904 NETIF_VLAN_FILTERING_FEATURES; 5905 requested_vlan_features = features & NETIF_VLAN_FILTERING_FEATURES; 5906 if (current_vlan_features ^ requested_vlan_features) { 5907 err = ice_set_vlan_filtering_features(vsi, features); 5908 if (err) 5909 return err; 5910 } 5911 5912 return 0; 5913 } 5914 5915 /** 5916 * ice_set_features - set the netdev feature flags 5917 * @netdev: ptr to the netdev being adjusted 5918 * @features: the feature set that the stack is suggesting 5919 */ 5920 static int 5921 ice_set_features(struct net_device *netdev, netdev_features_t features) 5922 { 5923 struct ice_netdev_priv *np = netdev_priv(netdev); 5924 struct ice_vsi *vsi = np->vsi; 5925 struct ice_pf *pf = vsi->back; 5926 int ret = 0; 5927 5928 /* Don't set any netdev advanced features with device in Safe Mode */ 5929 if (ice_is_safe_mode(vsi->back)) { 5930 dev_err(ice_pf_to_dev(vsi->back), "Device is in Safe Mode - not enabling advanced netdev features\n"); 5931 return ret; 5932 } 5933 5934 /* Do not change setting during reset */ 5935 if (ice_is_reset_in_progress(pf->state)) { 5936 dev_err(ice_pf_to_dev(vsi->back), "Device is resetting, changing advanced netdev features temporarily unavailable.\n"); 5937 return -EBUSY; 5938 } 5939 5940 /* Multiple features can be changed in one call so keep features in 5941 * separate if/else statements to guarantee each feature is checked 5942 */ 5943 if (features & NETIF_F_RXHASH && !(netdev->features & NETIF_F_RXHASH)) 5944 ice_vsi_manage_rss_lut(vsi, true); 5945 else if (!(features & NETIF_F_RXHASH) && 5946 netdev->features & NETIF_F_RXHASH) 5947 ice_vsi_manage_rss_lut(vsi, false); 5948 5949 ret = ice_set_vlan_features(netdev, features); 5950 if (ret) 5951 return ret; 5952 5953 if ((features & NETIF_F_NTUPLE) && 5954 !(netdev->features & NETIF_F_NTUPLE)) { 5955 ice_vsi_manage_fdir(vsi, true); 5956 ice_init_arfs(vsi); 5957 } else if (!(features & NETIF_F_NTUPLE) && 5958 (netdev->features & NETIF_F_NTUPLE)) { 5959 ice_vsi_manage_fdir(vsi, false); 5960 ice_clear_arfs(vsi); 5961 } 5962 5963 /* don't turn off hw_tc_offload when ADQ is already enabled */ 5964 if (!(features & NETIF_F_HW_TC) && ice_is_adq_active(pf)) { 5965 dev_err(ice_pf_to_dev(pf), "ADQ is active, can't turn hw_tc_offload off\n"); 5966 return -EACCES; 5967 } 5968 5969 if ((features & NETIF_F_HW_TC) && 5970 !(netdev->features & NETIF_F_HW_TC)) 5971 set_bit(ICE_FLAG_CLS_FLOWER, pf->flags); 5972 else 5973 clear_bit(ICE_FLAG_CLS_FLOWER, pf->flags); 5974 5975 return 0; 5976 } 5977 5978 /** 5979 * ice_vsi_vlan_setup - Setup VLAN offload properties on a PF VSI 5980 * @vsi: VSI to setup VLAN properties for 5981 */ 5982 static int ice_vsi_vlan_setup(struct ice_vsi *vsi) 5983 { 5984 int err; 5985 5986 err = ice_set_vlan_offload_features(vsi, vsi->netdev->features); 5987 if (err) 5988 return err; 5989 5990 err = ice_set_vlan_filtering_features(vsi, vsi->netdev->features); 5991 if (err) 5992 return err; 5993 5994 return ice_vsi_add_vlan_zero(vsi); 5995 } 5996 5997 /** 5998 * ice_vsi_cfg - Setup the VSI 5999 * @vsi: the VSI being configured 6000 * 6001 * Return 0 on success and negative value on error 6002 */ 6003 int ice_vsi_cfg(struct ice_vsi *vsi) 6004 { 6005 int err; 6006 6007 if (vsi->netdev) { 6008 ice_set_rx_mode(vsi->netdev); 6009 6010 if (vsi->type != ICE_VSI_LB) { 6011 err = ice_vsi_vlan_setup(vsi); 6012 6013 if (err) 6014 return err; 6015 } 6016 } 6017 ice_vsi_cfg_dcb_rings(vsi); 6018 6019 err = ice_vsi_cfg_lan_txqs(vsi); 6020 if (!err && ice_is_xdp_ena_vsi(vsi)) 6021 err = ice_vsi_cfg_xdp_txqs(vsi); 6022 if (!err) 6023 err = ice_vsi_cfg_rxqs(vsi); 6024 6025 return err; 6026 } 6027 6028 /* THEORY OF MODERATION: 6029 * The ice driver hardware works differently than the hardware that DIMLIB was 6030 * originally made for. ice hardware doesn't have packet count limits that 6031 * can trigger an interrupt, but it *does* have interrupt rate limit support, 6032 * which is hard-coded to a limit of 250,000 ints/second. 6033 * If not using dynamic moderation, the INTRL value can be modified 6034 * by ethtool rx-usecs-high. 6035 */ 6036 struct ice_dim { 6037 /* the throttle rate for interrupts, basically worst case delay before 6038 * an initial interrupt fires, value is stored in microseconds. 6039 */ 6040 u16 itr; 6041 }; 6042 6043 /* Make a different profile for Rx that doesn't allow quite so aggressive 6044 * moderation at the high end (it maxes out at 126us or about 8k interrupts a 6045 * second. 6046 */ 6047 static const struct ice_dim rx_profile[] = { 6048 {2}, /* 500,000 ints/s, capped at 250K by INTRL */ 6049 {8}, /* 125,000 ints/s */ 6050 {16}, /* 62,500 ints/s */ 6051 {62}, /* 16,129 ints/s */ 6052 {126} /* 7,936 ints/s */ 6053 }; 6054 6055 /* The transmit profile, which has the same sorts of values 6056 * as the previous struct 6057 */ 6058 static const struct ice_dim tx_profile[] = { 6059 {2}, /* 500,000 ints/s, capped at 250K by INTRL */ 6060 {8}, /* 125,000 ints/s */ 6061 {40}, /* 16,125 ints/s */ 6062 {128}, /* 7,812 ints/s */ 6063 {256} /* 3,906 ints/s */ 6064 }; 6065 6066 static void ice_tx_dim_work(struct work_struct *work) 6067 { 6068 struct ice_ring_container *rc; 6069 struct dim *dim; 6070 u16 itr; 6071 6072 dim = container_of(work, struct dim, work); 6073 rc = (struct ice_ring_container *)dim->priv; 6074 6075 WARN_ON(dim->profile_ix >= ARRAY_SIZE(tx_profile)); 6076 6077 /* look up the values in our local table */ 6078 itr = tx_profile[dim->profile_ix].itr; 6079 6080 ice_trace(tx_dim_work, container_of(rc, struct ice_q_vector, tx), dim); 6081 ice_write_itr(rc, itr); 6082 6083 dim->state = DIM_START_MEASURE; 6084 } 6085 6086 static void ice_rx_dim_work(struct work_struct *work) 6087 { 6088 struct ice_ring_container *rc; 6089 struct dim *dim; 6090 u16 itr; 6091 6092 dim = container_of(work, struct dim, work); 6093 rc = (struct ice_ring_container *)dim->priv; 6094 6095 WARN_ON(dim->profile_ix >= ARRAY_SIZE(rx_profile)); 6096 6097 /* look up the values in our local table */ 6098 itr = rx_profile[dim->profile_ix].itr; 6099 6100 ice_trace(rx_dim_work, container_of(rc, struct ice_q_vector, rx), dim); 6101 ice_write_itr(rc, itr); 6102 6103 dim->state = DIM_START_MEASURE; 6104 } 6105 6106 #define ICE_DIM_DEFAULT_PROFILE_IX 1 6107 6108 /** 6109 * ice_init_moderation - set up interrupt moderation 6110 * @q_vector: the vector containing rings to be configured 6111 * 6112 * Set up interrupt moderation registers, with the intent to do the right thing 6113 * when called from reset or from probe, and whether or not dynamic moderation 6114 * is enabled or not. Take special care to write all the registers in both 6115 * dynamic moderation mode or not in order to make sure hardware is in a known 6116 * state. 6117 */ 6118 static void ice_init_moderation(struct ice_q_vector *q_vector) 6119 { 6120 struct ice_ring_container *rc; 6121 bool tx_dynamic, rx_dynamic; 6122 6123 rc = &q_vector->tx; 6124 INIT_WORK(&rc->dim.work, ice_tx_dim_work); 6125 rc->dim.mode = DIM_CQ_PERIOD_MODE_START_FROM_EQE; 6126 rc->dim.profile_ix = ICE_DIM_DEFAULT_PROFILE_IX; 6127 rc->dim.priv = rc; 6128 tx_dynamic = ITR_IS_DYNAMIC(rc); 6129 6130 /* set the initial TX ITR to match the above */ 6131 ice_write_itr(rc, tx_dynamic ? 6132 tx_profile[rc->dim.profile_ix].itr : rc->itr_setting); 6133 6134 rc = &q_vector->rx; 6135 INIT_WORK(&rc->dim.work, ice_rx_dim_work); 6136 rc->dim.mode = DIM_CQ_PERIOD_MODE_START_FROM_EQE; 6137 rc->dim.profile_ix = ICE_DIM_DEFAULT_PROFILE_IX; 6138 rc->dim.priv = rc; 6139 rx_dynamic = ITR_IS_DYNAMIC(rc); 6140 6141 /* set the initial RX ITR to match the above */ 6142 ice_write_itr(rc, rx_dynamic ? rx_profile[rc->dim.profile_ix].itr : 6143 rc->itr_setting); 6144 6145 ice_set_q_vector_intrl(q_vector); 6146 } 6147 6148 /** 6149 * ice_napi_enable_all - Enable NAPI for all q_vectors in the VSI 6150 * @vsi: the VSI being configured 6151 */ 6152 static void ice_napi_enable_all(struct ice_vsi *vsi) 6153 { 6154 int q_idx; 6155 6156 if (!vsi->netdev) 6157 return; 6158 6159 ice_for_each_q_vector(vsi, q_idx) { 6160 struct ice_q_vector *q_vector = vsi->q_vectors[q_idx]; 6161 6162 ice_init_moderation(q_vector); 6163 6164 if (q_vector->rx.rx_ring || q_vector->tx.tx_ring) 6165 napi_enable(&q_vector->napi); 6166 } 6167 } 6168 6169 /** 6170 * ice_up_complete - Finish the last steps of bringing up a connection 6171 * @vsi: The VSI being configured 6172 * 6173 * Return 0 on success and negative value on error 6174 */ 6175 static int ice_up_complete(struct ice_vsi *vsi) 6176 { 6177 struct ice_pf *pf = vsi->back; 6178 int err; 6179 6180 ice_vsi_cfg_msix(vsi); 6181 6182 /* Enable only Rx rings, Tx rings were enabled by the FW when the 6183 * Tx queue group list was configured and the context bits were 6184 * programmed using ice_vsi_cfg_txqs 6185 */ 6186 err = ice_vsi_start_all_rx_rings(vsi); 6187 if (err) 6188 return err; 6189 6190 clear_bit(ICE_VSI_DOWN, vsi->state); 6191 ice_napi_enable_all(vsi); 6192 ice_vsi_ena_irq(vsi); 6193 6194 if (vsi->port_info && 6195 (vsi->port_info->phy.link_info.link_info & ICE_AQ_LINK_UP) && 6196 vsi->netdev) { 6197 ice_print_link_msg(vsi, true); 6198 netif_tx_start_all_queues(vsi->netdev); 6199 netif_carrier_on(vsi->netdev); 6200 if (!ice_is_e810(&pf->hw)) 6201 ice_ptp_link_change(pf, pf->hw.pf_id, true); 6202 } 6203 6204 /* Perform an initial read of the statistics registers now to 6205 * set the baseline so counters are ready when interface is up 6206 */ 6207 ice_update_eth_stats(vsi); 6208 ice_service_task_schedule(pf); 6209 6210 return 0; 6211 } 6212 6213 /** 6214 * ice_up - Bring the connection back up after being down 6215 * @vsi: VSI being configured 6216 */ 6217 int ice_up(struct ice_vsi *vsi) 6218 { 6219 int err; 6220 6221 err = ice_vsi_cfg(vsi); 6222 if (!err) 6223 err = ice_up_complete(vsi); 6224 6225 return err; 6226 } 6227 6228 /** 6229 * ice_fetch_u64_stats_per_ring - get packets and bytes stats per ring 6230 * @syncp: pointer to u64_stats_sync 6231 * @stats: stats that pkts and bytes count will be taken from 6232 * @pkts: packets stats counter 6233 * @bytes: bytes stats counter 6234 * 6235 * This function fetches stats from the ring considering the atomic operations 6236 * that needs to be performed to read u64 values in 32 bit machine. 6237 */ 6238 void 6239 ice_fetch_u64_stats_per_ring(struct u64_stats_sync *syncp, 6240 struct ice_q_stats stats, u64 *pkts, u64 *bytes) 6241 { 6242 unsigned int start; 6243 6244 do { 6245 start = u64_stats_fetch_begin_irq(syncp); 6246 *pkts = stats.pkts; 6247 *bytes = stats.bytes; 6248 } while (u64_stats_fetch_retry_irq(syncp, start)); 6249 } 6250 6251 /** 6252 * ice_update_vsi_tx_ring_stats - Update VSI Tx ring stats counters 6253 * @vsi: the VSI to be updated 6254 * @vsi_stats: the stats struct to be updated 6255 * @rings: rings to work on 6256 * @count: number of rings 6257 */ 6258 static void 6259 ice_update_vsi_tx_ring_stats(struct ice_vsi *vsi, 6260 struct rtnl_link_stats64 *vsi_stats, 6261 struct ice_tx_ring **rings, u16 count) 6262 { 6263 u16 i; 6264 6265 for (i = 0; i < count; i++) { 6266 struct ice_tx_ring *ring; 6267 u64 pkts = 0, bytes = 0; 6268 6269 ring = READ_ONCE(rings[i]); 6270 if (!ring) 6271 continue; 6272 ice_fetch_u64_stats_per_ring(&ring->syncp, ring->stats, &pkts, &bytes); 6273 vsi_stats->tx_packets += pkts; 6274 vsi_stats->tx_bytes += bytes; 6275 vsi->tx_restart += ring->tx_stats.restart_q; 6276 vsi->tx_busy += ring->tx_stats.tx_busy; 6277 vsi->tx_linearize += ring->tx_stats.tx_linearize; 6278 } 6279 } 6280 6281 /** 6282 * ice_update_vsi_ring_stats - Update VSI stats counters 6283 * @vsi: the VSI to be updated 6284 */ 6285 static void ice_update_vsi_ring_stats(struct ice_vsi *vsi) 6286 { 6287 struct rtnl_link_stats64 *vsi_stats; 6288 u64 pkts, bytes; 6289 int i; 6290 6291 vsi_stats = kzalloc(sizeof(*vsi_stats), GFP_ATOMIC); 6292 if (!vsi_stats) 6293 return; 6294 6295 /* reset non-netdev (extended) stats */ 6296 vsi->tx_restart = 0; 6297 vsi->tx_busy = 0; 6298 vsi->tx_linearize = 0; 6299 vsi->rx_buf_failed = 0; 6300 vsi->rx_page_failed = 0; 6301 6302 rcu_read_lock(); 6303 6304 /* update Tx rings counters */ 6305 ice_update_vsi_tx_ring_stats(vsi, vsi_stats, vsi->tx_rings, 6306 vsi->num_txq); 6307 6308 /* update Rx rings counters */ 6309 ice_for_each_rxq(vsi, i) { 6310 struct ice_rx_ring *ring = READ_ONCE(vsi->rx_rings[i]); 6311 6312 ice_fetch_u64_stats_per_ring(&ring->syncp, ring->stats, &pkts, &bytes); 6313 vsi_stats->rx_packets += pkts; 6314 vsi_stats->rx_bytes += bytes; 6315 vsi->rx_buf_failed += ring->rx_stats.alloc_buf_failed; 6316 vsi->rx_page_failed += ring->rx_stats.alloc_page_failed; 6317 } 6318 6319 /* update XDP Tx rings counters */ 6320 if (ice_is_xdp_ena_vsi(vsi)) 6321 ice_update_vsi_tx_ring_stats(vsi, vsi_stats, vsi->xdp_rings, 6322 vsi->num_xdp_txq); 6323 6324 rcu_read_unlock(); 6325 6326 vsi->net_stats.tx_packets = vsi_stats->tx_packets; 6327 vsi->net_stats.tx_bytes = vsi_stats->tx_bytes; 6328 vsi->net_stats.rx_packets = vsi_stats->rx_packets; 6329 vsi->net_stats.rx_bytes = vsi_stats->rx_bytes; 6330 6331 kfree(vsi_stats); 6332 } 6333 6334 /** 6335 * ice_update_vsi_stats - Update VSI stats counters 6336 * @vsi: the VSI to be updated 6337 */ 6338 void ice_update_vsi_stats(struct ice_vsi *vsi) 6339 { 6340 struct rtnl_link_stats64 *cur_ns = &vsi->net_stats; 6341 struct ice_eth_stats *cur_es = &vsi->eth_stats; 6342 struct ice_pf *pf = vsi->back; 6343 6344 if (test_bit(ICE_VSI_DOWN, vsi->state) || 6345 test_bit(ICE_CFG_BUSY, pf->state)) 6346 return; 6347 6348 /* get stats as recorded by Tx/Rx rings */ 6349 ice_update_vsi_ring_stats(vsi); 6350 6351 /* get VSI stats as recorded by the hardware */ 6352 ice_update_eth_stats(vsi); 6353 6354 cur_ns->tx_errors = cur_es->tx_errors; 6355 cur_ns->rx_dropped = cur_es->rx_discards; 6356 cur_ns->tx_dropped = cur_es->tx_discards; 6357 cur_ns->multicast = cur_es->rx_multicast; 6358 6359 /* update some more netdev stats if this is main VSI */ 6360 if (vsi->type == ICE_VSI_PF) { 6361 cur_ns->rx_crc_errors = pf->stats.crc_errors; 6362 cur_ns->rx_errors = pf->stats.crc_errors + 6363 pf->stats.illegal_bytes + 6364 pf->stats.rx_len_errors + 6365 pf->stats.rx_undersize + 6366 pf->hw_csum_rx_error + 6367 pf->stats.rx_jabber + 6368 pf->stats.rx_fragments + 6369 pf->stats.rx_oversize; 6370 cur_ns->rx_length_errors = pf->stats.rx_len_errors; 6371 /* record drops from the port level */ 6372 cur_ns->rx_missed_errors = pf->stats.eth.rx_discards; 6373 } 6374 } 6375 6376 /** 6377 * ice_update_pf_stats - Update PF port stats counters 6378 * @pf: PF whose stats needs to be updated 6379 */ 6380 void ice_update_pf_stats(struct ice_pf *pf) 6381 { 6382 struct ice_hw_port_stats *prev_ps, *cur_ps; 6383 struct ice_hw *hw = &pf->hw; 6384 u16 fd_ctr_base; 6385 u8 port; 6386 6387 port = hw->port_info->lport; 6388 prev_ps = &pf->stats_prev; 6389 cur_ps = &pf->stats; 6390 6391 ice_stat_update40(hw, GLPRT_GORCL(port), pf->stat_prev_loaded, 6392 &prev_ps->eth.rx_bytes, 6393 &cur_ps->eth.rx_bytes); 6394 6395 ice_stat_update40(hw, GLPRT_UPRCL(port), pf->stat_prev_loaded, 6396 &prev_ps->eth.rx_unicast, 6397 &cur_ps->eth.rx_unicast); 6398 6399 ice_stat_update40(hw, GLPRT_MPRCL(port), pf->stat_prev_loaded, 6400 &prev_ps->eth.rx_multicast, 6401 &cur_ps->eth.rx_multicast); 6402 6403 ice_stat_update40(hw, GLPRT_BPRCL(port), pf->stat_prev_loaded, 6404 &prev_ps->eth.rx_broadcast, 6405 &cur_ps->eth.rx_broadcast); 6406 6407 ice_stat_update32(hw, PRTRPB_RDPC, pf->stat_prev_loaded, 6408 &prev_ps->eth.rx_discards, 6409 &cur_ps->eth.rx_discards); 6410 6411 ice_stat_update40(hw, GLPRT_GOTCL(port), pf->stat_prev_loaded, 6412 &prev_ps->eth.tx_bytes, 6413 &cur_ps->eth.tx_bytes); 6414 6415 ice_stat_update40(hw, GLPRT_UPTCL(port), pf->stat_prev_loaded, 6416 &prev_ps->eth.tx_unicast, 6417 &cur_ps->eth.tx_unicast); 6418 6419 ice_stat_update40(hw, GLPRT_MPTCL(port), pf->stat_prev_loaded, 6420 &prev_ps->eth.tx_multicast, 6421 &cur_ps->eth.tx_multicast); 6422 6423 ice_stat_update40(hw, GLPRT_BPTCL(port), pf->stat_prev_loaded, 6424 &prev_ps->eth.tx_broadcast, 6425 &cur_ps->eth.tx_broadcast); 6426 6427 ice_stat_update32(hw, GLPRT_TDOLD(port), pf->stat_prev_loaded, 6428 &prev_ps->tx_dropped_link_down, 6429 &cur_ps->tx_dropped_link_down); 6430 6431 ice_stat_update40(hw, GLPRT_PRC64L(port), pf->stat_prev_loaded, 6432 &prev_ps->rx_size_64, &cur_ps->rx_size_64); 6433 6434 ice_stat_update40(hw, GLPRT_PRC127L(port), pf->stat_prev_loaded, 6435 &prev_ps->rx_size_127, &cur_ps->rx_size_127); 6436 6437 ice_stat_update40(hw, GLPRT_PRC255L(port), pf->stat_prev_loaded, 6438 &prev_ps->rx_size_255, &cur_ps->rx_size_255); 6439 6440 ice_stat_update40(hw, GLPRT_PRC511L(port), pf->stat_prev_loaded, 6441 &prev_ps->rx_size_511, &cur_ps->rx_size_511); 6442 6443 ice_stat_update40(hw, GLPRT_PRC1023L(port), pf->stat_prev_loaded, 6444 &prev_ps->rx_size_1023, &cur_ps->rx_size_1023); 6445 6446 ice_stat_update40(hw, GLPRT_PRC1522L(port), pf->stat_prev_loaded, 6447 &prev_ps->rx_size_1522, &cur_ps->rx_size_1522); 6448 6449 ice_stat_update40(hw, GLPRT_PRC9522L(port), pf->stat_prev_loaded, 6450 &prev_ps->rx_size_big, &cur_ps->rx_size_big); 6451 6452 ice_stat_update40(hw, GLPRT_PTC64L(port), pf->stat_prev_loaded, 6453 &prev_ps->tx_size_64, &cur_ps->tx_size_64); 6454 6455 ice_stat_update40(hw, GLPRT_PTC127L(port), pf->stat_prev_loaded, 6456 &prev_ps->tx_size_127, &cur_ps->tx_size_127); 6457 6458 ice_stat_update40(hw, GLPRT_PTC255L(port), pf->stat_prev_loaded, 6459 &prev_ps->tx_size_255, &cur_ps->tx_size_255); 6460 6461 ice_stat_update40(hw, GLPRT_PTC511L(port), pf->stat_prev_loaded, 6462 &prev_ps->tx_size_511, &cur_ps->tx_size_511); 6463 6464 ice_stat_update40(hw, GLPRT_PTC1023L(port), pf->stat_prev_loaded, 6465 &prev_ps->tx_size_1023, &cur_ps->tx_size_1023); 6466 6467 ice_stat_update40(hw, GLPRT_PTC1522L(port), pf->stat_prev_loaded, 6468 &prev_ps->tx_size_1522, &cur_ps->tx_size_1522); 6469 6470 ice_stat_update40(hw, GLPRT_PTC9522L(port), pf->stat_prev_loaded, 6471 &prev_ps->tx_size_big, &cur_ps->tx_size_big); 6472 6473 fd_ctr_base = hw->fd_ctr_base; 6474 6475 ice_stat_update40(hw, 6476 GLSTAT_FD_CNT0L(ICE_FD_SB_STAT_IDX(fd_ctr_base)), 6477 pf->stat_prev_loaded, &prev_ps->fd_sb_match, 6478 &cur_ps->fd_sb_match); 6479 ice_stat_update32(hw, GLPRT_LXONRXC(port), pf->stat_prev_loaded, 6480 &prev_ps->link_xon_rx, &cur_ps->link_xon_rx); 6481 6482 ice_stat_update32(hw, GLPRT_LXOFFRXC(port), pf->stat_prev_loaded, 6483 &prev_ps->link_xoff_rx, &cur_ps->link_xoff_rx); 6484 6485 ice_stat_update32(hw, GLPRT_LXONTXC(port), pf->stat_prev_loaded, 6486 &prev_ps->link_xon_tx, &cur_ps->link_xon_tx); 6487 6488 ice_stat_update32(hw, GLPRT_LXOFFTXC(port), pf->stat_prev_loaded, 6489 &prev_ps->link_xoff_tx, &cur_ps->link_xoff_tx); 6490 6491 ice_update_dcb_stats(pf); 6492 6493 ice_stat_update32(hw, GLPRT_CRCERRS(port), pf->stat_prev_loaded, 6494 &prev_ps->crc_errors, &cur_ps->crc_errors); 6495 6496 ice_stat_update32(hw, GLPRT_ILLERRC(port), pf->stat_prev_loaded, 6497 &prev_ps->illegal_bytes, &cur_ps->illegal_bytes); 6498 6499 ice_stat_update32(hw, GLPRT_MLFC(port), pf->stat_prev_loaded, 6500 &prev_ps->mac_local_faults, 6501 &cur_ps->mac_local_faults); 6502 6503 ice_stat_update32(hw, GLPRT_MRFC(port), pf->stat_prev_loaded, 6504 &prev_ps->mac_remote_faults, 6505 &cur_ps->mac_remote_faults); 6506 6507 ice_stat_update32(hw, GLPRT_RLEC(port), pf->stat_prev_loaded, 6508 &prev_ps->rx_len_errors, &cur_ps->rx_len_errors); 6509 6510 ice_stat_update32(hw, GLPRT_RUC(port), pf->stat_prev_loaded, 6511 &prev_ps->rx_undersize, &cur_ps->rx_undersize); 6512 6513 ice_stat_update32(hw, GLPRT_RFC(port), pf->stat_prev_loaded, 6514 &prev_ps->rx_fragments, &cur_ps->rx_fragments); 6515 6516 ice_stat_update32(hw, GLPRT_ROC(port), pf->stat_prev_loaded, 6517 &prev_ps->rx_oversize, &cur_ps->rx_oversize); 6518 6519 ice_stat_update32(hw, GLPRT_RJC(port), pf->stat_prev_loaded, 6520 &prev_ps->rx_jabber, &cur_ps->rx_jabber); 6521 6522 cur_ps->fd_sb_status = test_bit(ICE_FLAG_FD_ENA, pf->flags) ? 1 : 0; 6523 6524 pf->stat_prev_loaded = true; 6525 } 6526 6527 /** 6528 * ice_get_stats64 - get statistics for network device structure 6529 * @netdev: network interface device structure 6530 * @stats: main device statistics structure 6531 */ 6532 static 6533 void ice_get_stats64(struct net_device *netdev, struct rtnl_link_stats64 *stats) 6534 { 6535 struct ice_netdev_priv *np = netdev_priv(netdev); 6536 struct rtnl_link_stats64 *vsi_stats; 6537 struct ice_vsi *vsi = np->vsi; 6538 6539 vsi_stats = &vsi->net_stats; 6540 6541 if (!vsi->num_txq || !vsi->num_rxq) 6542 return; 6543 6544 /* netdev packet/byte stats come from ring counter. These are obtained 6545 * by summing up ring counters (done by ice_update_vsi_ring_stats). 6546 * But, only call the update routine and read the registers if VSI is 6547 * not down. 6548 */ 6549 if (!test_bit(ICE_VSI_DOWN, vsi->state)) 6550 ice_update_vsi_ring_stats(vsi); 6551 stats->tx_packets = vsi_stats->tx_packets; 6552 stats->tx_bytes = vsi_stats->tx_bytes; 6553 stats->rx_packets = vsi_stats->rx_packets; 6554 stats->rx_bytes = vsi_stats->rx_bytes; 6555 6556 /* The rest of the stats can be read from the hardware but instead we 6557 * just return values that the watchdog task has already obtained from 6558 * the hardware. 6559 */ 6560 stats->multicast = vsi_stats->multicast; 6561 stats->tx_errors = vsi_stats->tx_errors; 6562 stats->tx_dropped = vsi_stats->tx_dropped; 6563 stats->rx_errors = vsi_stats->rx_errors; 6564 stats->rx_dropped = vsi_stats->rx_dropped; 6565 stats->rx_crc_errors = vsi_stats->rx_crc_errors; 6566 stats->rx_length_errors = vsi_stats->rx_length_errors; 6567 } 6568 6569 /** 6570 * ice_napi_disable_all - Disable NAPI for all q_vectors in the VSI 6571 * @vsi: VSI having NAPI disabled 6572 */ 6573 static void ice_napi_disable_all(struct ice_vsi *vsi) 6574 { 6575 int q_idx; 6576 6577 if (!vsi->netdev) 6578 return; 6579 6580 ice_for_each_q_vector(vsi, q_idx) { 6581 struct ice_q_vector *q_vector = vsi->q_vectors[q_idx]; 6582 6583 if (q_vector->rx.rx_ring || q_vector->tx.tx_ring) 6584 napi_disable(&q_vector->napi); 6585 6586 cancel_work_sync(&q_vector->tx.dim.work); 6587 cancel_work_sync(&q_vector->rx.dim.work); 6588 } 6589 } 6590 6591 /** 6592 * ice_down - Shutdown the connection 6593 * @vsi: The VSI being stopped 6594 * 6595 * Caller of this function is expected to set the vsi->state ICE_DOWN bit 6596 */ 6597 int ice_down(struct ice_vsi *vsi) 6598 { 6599 int i, tx_err, rx_err, link_err = 0, vlan_err = 0; 6600 6601 WARN_ON(!test_bit(ICE_VSI_DOWN, vsi->state)); 6602 6603 if (vsi->netdev && vsi->type == ICE_VSI_PF) { 6604 vlan_err = ice_vsi_del_vlan_zero(vsi); 6605 if (!ice_is_e810(&vsi->back->hw)) 6606 ice_ptp_link_change(vsi->back, vsi->back->hw.pf_id, false); 6607 netif_carrier_off(vsi->netdev); 6608 netif_tx_disable(vsi->netdev); 6609 } else if (vsi->type == ICE_VSI_SWITCHDEV_CTRL) { 6610 ice_eswitch_stop_all_tx_queues(vsi->back); 6611 } 6612 6613 ice_vsi_dis_irq(vsi); 6614 6615 tx_err = ice_vsi_stop_lan_tx_rings(vsi, ICE_NO_RESET, 0); 6616 if (tx_err) 6617 netdev_err(vsi->netdev, "Failed stop Tx rings, VSI %d error %d\n", 6618 vsi->vsi_num, tx_err); 6619 if (!tx_err && ice_is_xdp_ena_vsi(vsi)) { 6620 tx_err = ice_vsi_stop_xdp_tx_rings(vsi); 6621 if (tx_err) 6622 netdev_err(vsi->netdev, "Failed stop XDP rings, VSI %d error %d\n", 6623 vsi->vsi_num, tx_err); 6624 } 6625 6626 rx_err = ice_vsi_stop_all_rx_rings(vsi); 6627 if (rx_err) 6628 netdev_err(vsi->netdev, "Failed stop Rx rings, VSI %d error %d\n", 6629 vsi->vsi_num, rx_err); 6630 6631 ice_napi_disable_all(vsi); 6632 6633 if (test_bit(ICE_FLAG_LINK_DOWN_ON_CLOSE_ENA, vsi->back->flags)) { 6634 link_err = ice_force_phys_link_state(vsi, false); 6635 if (link_err) 6636 netdev_err(vsi->netdev, "Failed to set physical link down, VSI %d error %d\n", 6637 vsi->vsi_num, link_err); 6638 } 6639 6640 ice_for_each_txq(vsi, i) 6641 ice_clean_tx_ring(vsi->tx_rings[i]); 6642 6643 ice_for_each_rxq(vsi, i) 6644 ice_clean_rx_ring(vsi->rx_rings[i]); 6645 6646 if (tx_err || rx_err || link_err || vlan_err) { 6647 netdev_err(vsi->netdev, "Failed to close VSI 0x%04X on switch 0x%04X\n", 6648 vsi->vsi_num, vsi->vsw->sw_id); 6649 return -EIO; 6650 } 6651 6652 return 0; 6653 } 6654 6655 /** 6656 * ice_vsi_setup_tx_rings - Allocate VSI Tx queue resources 6657 * @vsi: VSI having resources allocated 6658 * 6659 * Return 0 on success, negative on failure 6660 */ 6661 int ice_vsi_setup_tx_rings(struct ice_vsi *vsi) 6662 { 6663 int i, err = 0; 6664 6665 if (!vsi->num_txq) { 6666 dev_err(ice_pf_to_dev(vsi->back), "VSI %d has 0 Tx queues\n", 6667 vsi->vsi_num); 6668 return -EINVAL; 6669 } 6670 6671 ice_for_each_txq(vsi, i) { 6672 struct ice_tx_ring *ring = vsi->tx_rings[i]; 6673 6674 if (!ring) 6675 return -EINVAL; 6676 6677 if (vsi->netdev) 6678 ring->netdev = vsi->netdev; 6679 err = ice_setup_tx_ring(ring); 6680 if (err) 6681 break; 6682 } 6683 6684 return err; 6685 } 6686 6687 /** 6688 * ice_vsi_setup_rx_rings - Allocate VSI Rx queue resources 6689 * @vsi: VSI having resources allocated 6690 * 6691 * Return 0 on success, negative on failure 6692 */ 6693 int ice_vsi_setup_rx_rings(struct ice_vsi *vsi) 6694 { 6695 int i, err = 0; 6696 6697 if (!vsi->num_rxq) { 6698 dev_err(ice_pf_to_dev(vsi->back), "VSI %d has 0 Rx queues\n", 6699 vsi->vsi_num); 6700 return -EINVAL; 6701 } 6702 6703 ice_for_each_rxq(vsi, i) { 6704 struct ice_rx_ring *ring = vsi->rx_rings[i]; 6705 6706 if (!ring) 6707 return -EINVAL; 6708 6709 if (vsi->netdev) 6710 ring->netdev = vsi->netdev; 6711 err = ice_setup_rx_ring(ring); 6712 if (err) 6713 break; 6714 } 6715 6716 return err; 6717 } 6718 6719 /** 6720 * ice_vsi_open_ctrl - open control VSI for use 6721 * @vsi: the VSI to open 6722 * 6723 * Initialization of the Control VSI 6724 * 6725 * Returns 0 on success, negative value on error 6726 */ 6727 int ice_vsi_open_ctrl(struct ice_vsi *vsi) 6728 { 6729 char int_name[ICE_INT_NAME_STR_LEN]; 6730 struct ice_pf *pf = vsi->back; 6731 struct device *dev; 6732 int err; 6733 6734 dev = ice_pf_to_dev(pf); 6735 /* allocate descriptors */ 6736 err = ice_vsi_setup_tx_rings(vsi); 6737 if (err) 6738 goto err_setup_tx; 6739 6740 err = ice_vsi_setup_rx_rings(vsi); 6741 if (err) 6742 goto err_setup_rx; 6743 6744 err = ice_vsi_cfg(vsi); 6745 if (err) 6746 goto err_setup_rx; 6747 6748 snprintf(int_name, sizeof(int_name) - 1, "%s-%s:ctrl", 6749 dev_driver_string(dev), dev_name(dev)); 6750 err = ice_vsi_req_irq_msix(vsi, int_name); 6751 if (err) 6752 goto err_setup_rx; 6753 6754 ice_vsi_cfg_msix(vsi); 6755 6756 err = ice_vsi_start_all_rx_rings(vsi); 6757 if (err) 6758 goto err_up_complete; 6759 6760 clear_bit(ICE_VSI_DOWN, vsi->state); 6761 ice_vsi_ena_irq(vsi); 6762 6763 return 0; 6764 6765 err_up_complete: 6766 ice_down(vsi); 6767 err_setup_rx: 6768 ice_vsi_free_rx_rings(vsi); 6769 err_setup_tx: 6770 ice_vsi_free_tx_rings(vsi); 6771 6772 return err; 6773 } 6774 6775 /** 6776 * ice_vsi_open - Called when a network interface is made active 6777 * @vsi: the VSI to open 6778 * 6779 * Initialization of the VSI 6780 * 6781 * Returns 0 on success, negative value on error 6782 */ 6783 int ice_vsi_open(struct ice_vsi *vsi) 6784 { 6785 char int_name[ICE_INT_NAME_STR_LEN]; 6786 struct ice_pf *pf = vsi->back; 6787 int err; 6788 6789 /* allocate descriptors */ 6790 err = ice_vsi_setup_tx_rings(vsi); 6791 if (err) 6792 goto err_setup_tx; 6793 6794 err = ice_vsi_setup_rx_rings(vsi); 6795 if (err) 6796 goto err_setup_rx; 6797 6798 err = ice_vsi_cfg(vsi); 6799 if (err) 6800 goto err_setup_rx; 6801 6802 snprintf(int_name, sizeof(int_name) - 1, "%s-%s", 6803 dev_driver_string(ice_pf_to_dev(pf)), vsi->netdev->name); 6804 err = ice_vsi_req_irq_msix(vsi, int_name); 6805 if (err) 6806 goto err_setup_rx; 6807 6808 if (vsi->type == ICE_VSI_PF) { 6809 /* Notify the stack of the actual queue counts. */ 6810 err = netif_set_real_num_tx_queues(vsi->netdev, vsi->num_txq); 6811 if (err) 6812 goto err_set_qs; 6813 6814 err = netif_set_real_num_rx_queues(vsi->netdev, vsi->num_rxq); 6815 if (err) 6816 goto err_set_qs; 6817 } 6818 6819 err = ice_up_complete(vsi); 6820 if (err) 6821 goto err_up_complete; 6822 6823 return 0; 6824 6825 err_up_complete: 6826 ice_down(vsi); 6827 err_set_qs: 6828 ice_vsi_free_irq(vsi); 6829 err_setup_rx: 6830 ice_vsi_free_rx_rings(vsi); 6831 err_setup_tx: 6832 ice_vsi_free_tx_rings(vsi); 6833 6834 return err; 6835 } 6836 6837 /** 6838 * ice_vsi_release_all - Delete all VSIs 6839 * @pf: PF from which all VSIs are being removed 6840 */ 6841 static void ice_vsi_release_all(struct ice_pf *pf) 6842 { 6843 int err, i; 6844 6845 if (!pf->vsi) 6846 return; 6847 6848 ice_for_each_vsi(pf, i) { 6849 if (!pf->vsi[i]) 6850 continue; 6851 6852 if (pf->vsi[i]->type == ICE_VSI_CHNL) 6853 continue; 6854 6855 err = ice_vsi_release(pf->vsi[i]); 6856 if (err) 6857 dev_dbg(ice_pf_to_dev(pf), "Failed to release pf->vsi[%d], err %d, vsi_num = %d\n", 6858 i, err, pf->vsi[i]->vsi_num); 6859 } 6860 } 6861 6862 /** 6863 * ice_vsi_rebuild_by_type - Rebuild VSI of a given type 6864 * @pf: pointer to the PF instance 6865 * @type: VSI type to rebuild 6866 * 6867 * Iterates through the pf->vsi array and rebuilds VSIs of the requested type 6868 */ 6869 static int ice_vsi_rebuild_by_type(struct ice_pf *pf, enum ice_vsi_type type) 6870 { 6871 struct device *dev = ice_pf_to_dev(pf); 6872 int i, err; 6873 6874 ice_for_each_vsi(pf, i) { 6875 struct ice_vsi *vsi = pf->vsi[i]; 6876 6877 if (!vsi || vsi->type != type) 6878 continue; 6879 6880 /* rebuild the VSI */ 6881 err = ice_vsi_rebuild(vsi, true); 6882 if (err) { 6883 dev_err(dev, "rebuild VSI failed, err %d, VSI index %d, type %s\n", 6884 err, vsi->idx, ice_vsi_type_str(type)); 6885 return err; 6886 } 6887 6888 /* replay filters for the VSI */ 6889 err = ice_replay_vsi(&pf->hw, vsi->idx); 6890 if (err) { 6891 dev_err(dev, "replay VSI failed, error %d, VSI index %d, type %s\n", 6892 err, vsi->idx, ice_vsi_type_str(type)); 6893 return err; 6894 } 6895 6896 /* Re-map HW VSI number, using VSI handle that has been 6897 * previously validated in ice_replay_vsi() call above 6898 */ 6899 vsi->vsi_num = ice_get_hw_vsi_num(&pf->hw, vsi->idx); 6900 6901 /* enable the VSI */ 6902 err = ice_ena_vsi(vsi, false); 6903 if (err) { 6904 dev_err(dev, "enable VSI failed, err %d, VSI index %d, type %s\n", 6905 err, vsi->idx, ice_vsi_type_str(type)); 6906 return err; 6907 } 6908 6909 dev_info(dev, "VSI rebuilt. VSI index %d, type %s\n", vsi->idx, 6910 ice_vsi_type_str(type)); 6911 } 6912 6913 return 0; 6914 } 6915 6916 /** 6917 * ice_update_pf_netdev_link - Update PF netdev link status 6918 * @pf: pointer to the PF instance 6919 */ 6920 static void ice_update_pf_netdev_link(struct ice_pf *pf) 6921 { 6922 bool link_up; 6923 int i; 6924 6925 ice_for_each_vsi(pf, i) { 6926 struct ice_vsi *vsi = pf->vsi[i]; 6927 6928 if (!vsi || vsi->type != ICE_VSI_PF) 6929 return; 6930 6931 ice_get_link_status(pf->vsi[i]->port_info, &link_up); 6932 if (link_up) { 6933 netif_carrier_on(pf->vsi[i]->netdev); 6934 netif_tx_wake_all_queues(pf->vsi[i]->netdev); 6935 } else { 6936 netif_carrier_off(pf->vsi[i]->netdev); 6937 netif_tx_stop_all_queues(pf->vsi[i]->netdev); 6938 } 6939 } 6940 } 6941 6942 /** 6943 * ice_rebuild - rebuild after reset 6944 * @pf: PF to rebuild 6945 * @reset_type: type of reset 6946 * 6947 * Do not rebuild VF VSI in this flow because that is already handled via 6948 * ice_reset_all_vfs(). This is because requirements for resetting a VF after a 6949 * PFR/CORER/GLOBER/etc. are different than the normal flow. Also, we don't want 6950 * to reset/rebuild all the VF VSI twice. 6951 */ 6952 static void ice_rebuild(struct ice_pf *pf, enum ice_reset_req reset_type) 6953 { 6954 struct device *dev = ice_pf_to_dev(pf); 6955 struct ice_hw *hw = &pf->hw; 6956 bool dvm; 6957 int err; 6958 6959 if (test_bit(ICE_DOWN, pf->state)) 6960 goto clear_recovery; 6961 6962 dev_dbg(dev, "rebuilding PF after reset_type=%d\n", reset_type); 6963 6964 #define ICE_EMP_RESET_SLEEP_MS 5000 6965 if (reset_type == ICE_RESET_EMPR) { 6966 /* If an EMP reset has occurred, any previously pending flash 6967 * update will have completed. We no longer know whether or 6968 * not the NVM update EMP reset is restricted. 6969 */ 6970 pf->fw_emp_reset_disabled = false; 6971 6972 msleep(ICE_EMP_RESET_SLEEP_MS); 6973 } 6974 6975 err = ice_init_all_ctrlq(hw); 6976 if (err) { 6977 dev_err(dev, "control queues init failed %d\n", err); 6978 goto err_init_ctrlq; 6979 } 6980 6981 /* if DDP was previously loaded successfully */ 6982 if (!ice_is_safe_mode(pf)) { 6983 /* reload the SW DB of filter tables */ 6984 if (reset_type == ICE_RESET_PFR) 6985 ice_fill_blk_tbls(hw); 6986 else 6987 /* Reload DDP Package after CORER/GLOBR reset */ 6988 ice_load_pkg(NULL, pf); 6989 } 6990 6991 err = ice_clear_pf_cfg(hw); 6992 if (err) { 6993 dev_err(dev, "clear PF configuration failed %d\n", err); 6994 goto err_init_ctrlq; 6995 } 6996 6997 if (pf->first_sw->dflt_vsi_ena) 6998 dev_info(dev, "Clearing default VSI, re-enable after reset completes\n"); 6999 /* clear the default VSI configuration if it exists */ 7000 pf->first_sw->dflt_vsi = NULL; 7001 pf->first_sw->dflt_vsi_ena = false; 7002 7003 ice_clear_pxe_mode(hw); 7004 7005 err = ice_init_nvm(hw); 7006 if (err) { 7007 dev_err(dev, "ice_init_nvm failed %d\n", err); 7008 goto err_init_ctrlq; 7009 } 7010 7011 err = ice_get_caps(hw); 7012 if (err) { 7013 dev_err(dev, "ice_get_caps failed %d\n", err); 7014 goto err_init_ctrlq; 7015 } 7016 7017 err = ice_aq_set_mac_cfg(hw, ICE_AQ_SET_MAC_FRAME_SIZE_MAX, NULL); 7018 if (err) { 7019 dev_err(dev, "set_mac_cfg failed %d\n", err); 7020 goto err_init_ctrlq; 7021 } 7022 7023 dvm = ice_is_dvm_ena(hw); 7024 7025 err = ice_aq_set_port_params(pf->hw.port_info, dvm, NULL); 7026 if (err) 7027 goto err_init_ctrlq; 7028 7029 err = ice_sched_init_port(hw->port_info); 7030 if (err) 7031 goto err_sched_init_port; 7032 7033 /* start misc vector */ 7034 err = ice_req_irq_msix_misc(pf); 7035 if (err) { 7036 dev_err(dev, "misc vector setup failed: %d\n", err); 7037 goto err_sched_init_port; 7038 } 7039 7040 if (test_bit(ICE_FLAG_FD_ENA, pf->flags)) { 7041 wr32(hw, PFQF_FD_ENA, PFQF_FD_ENA_FD_ENA_M); 7042 if (!rd32(hw, PFQF_FD_SIZE)) { 7043 u16 unused, guar, b_effort; 7044 7045 guar = hw->func_caps.fd_fltr_guar; 7046 b_effort = hw->func_caps.fd_fltr_best_effort; 7047 7048 /* force guaranteed filter pool for PF */ 7049 ice_alloc_fd_guar_item(hw, &unused, guar); 7050 /* force shared filter pool for PF */ 7051 ice_alloc_fd_shrd_item(hw, &unused, b_effort); 7052 } 7053 } 7054 7055 if (test_bit(ICE_FLAG_DCB_ENA, pf->flags)) 7056 ice_dcb_rebuild(pf); 7057 7058 /* If the PF previously had enabled PTP, PTP init needs to happen before 7059 * the VSI rebuild. If not, this causes the PTP link status events to 7060 * fail. 7061 */ 7062 if (test_bit(ICE_FLAG_PTP_SUPPORTED, pf->flags)) 7063 ice_ptp_reset(pf); 7064 7065 if (ice_is_feature_supported(pf, ICE_F_GNSS)) 7066 ice_gnss_init(pf); 7067 7068 /* rebuild PF VSI */ 7069 err = ice_vsi_rebuild_by_type(pf, ICE_VSI_PF); 7070 if (err) { 7071 dev_err(dev, "PF VSI rebuild failed: %d\n", err); 7072 goto err_vsi_rebuild; 7073 } 7074 7075 /* configure PTP timestamping after VSI rebuild */ 7076 if (test_bit(ICE_FLAG_PTP_SUPPORTED, pf->flags)) 7077 ice_ptp_cfg_timestamp(pf, false); 7078 7079 err = ice_vsi_rebuild_by_type(pf, ICE_VSI_SWITCHDEV_CTRL); 7080 if (err) { 7081 dev_err(dev, "Switchdev CTRL VSI rebuild failed: %d\n", err); 7082 goto err_vsi_rebuild; 7083 } 7084 7085 if (reset_type == ICE_RESET_PFR) { 7086 err = ice_rebuild_channels(pf); 7087 if (err) { 7088 dev_err(dev, "failed to rebuild and replay ADQ VSIs, err %d\n", 7089 err); 7090 goto err_vsi_rebuild; 7091 } 7092 } 7093 7094 /* If Flow Director is active */ 7095 if (test_bit(ICE_FLAG_FD_ENA, pf->flags)) { 7096 err = ice_vsi_rebuild_by_type(pf, ICE_VSI_CTRL); 7097 if (err) { 7098 dev_err(dev, "control VSI rebuild failed: %d\n", err); 7099 goto err_vsi_rebuild; 7100 } 7101 7102 /* replay HW Flow Director recipes */ 7103 if (hw->fdir_prof) 7104 ice_fdir_replay_flows(hw); 7105 7106 /* replay Flow Director filters */ 7107 ice_fdir_replay_fltrs(pf); 7108 7109 ice_rebuild_arfs(pf); 7110 } 7111 7112 ice_update_pf_netdev_link(pf); 7113 7114 /* tell the firmware we are up */ 7115 err = ice_send_version(pf); 7116 if (err) { 7117 dev_err(dev, "Rebuild failed due to error sending driver version: %d\n", 7118 err); 7119 goto err_vsi_rebuild; 7120 } 7121 7122 ice_replay_post(hw); 7123 7124 /* if we get here, reset flow is successful */ 7125 clear_bit(ICE_RESET_FAILED, pf->state); 7126 7127 ice_plug_aux_dev(pf); 7128 return; 7129 7130 err_vsi_rebuild: 7131 err_sched_init_port: 7132 ice_sched_cleanup_all(hw); 7133 err_init_ctrlq: 7134 ice_shutdown_all_ctrlq(hw); 7135 set_bit(ICE_RESET_FAILED, pf->state); 7136 clear_recovery: 7137 /* set this bit in PF state to control service task scheduling */ 7138 set_bit(ICE_NEEDS_RESTART, pf->state); 7139 dev_err(dev, "Rebuild failed, unload and reload driver\n"); 7140 } 7141 7142 /** 7143 * ice_max_xdp_frame_size - returns the maximum allowed frame size for XDP 7144 * @vsi: Pointer to VSI structure 7145 */ 7146 static int ice_max_xdp_frame_size(struct ice_vsi *vsi) 7147 { 7148 if (PAGE_SIZE >= 8192 || test_bit(ICE_FLAG_LEGACY_RX, vsi->back->flags)) 7149 return ICE_RXBUF_2048 - XDP_PACKET_HEADROOM; 7150 else 7151 return ICE_RXBUF_3072; 7152 } 7153 7154 /** 7155 * ice_change_mtu - NDO callback to change the MTU 7156 * @netdev: network interface device structure 7157 * @new_mtu: new value for maximum frame size 7158 * 7159 * Returns 0 on success, negative on failure 7160 */ 7161 static int ice_change_mtu(struct net_device *netdev, int new_mtu) 7162 { 7163 struct ice_netdev_priv *np = netdev_priv(netdev); 7164 struct ice_vsi *vsi = np->vsi; 7165 struct ice_pf *pf = vsi->back; 7166 u8 count = 0; 7167 int err = 0; 7168 7169 if (new_mtu == (int)netdev->mtu) { 7170 netdev_warn(netdev, "MTU is already %u\n", netdev->mtu); 7171 return 0; 7172 } 7173 7174 if (ice_is_xdp_ena_vsi(vsi)) { 7175 int frame_size = ice_max_xdp_frame_size(vsi); 7176 7177 if (new_mtu + ICE_ETH_PKT_HDR_PAD > frame_size) { 7178 netdev_err(netdev, "max MTU for XDP usage is %d\n", 7179 frame_size - ICE_ETH_PKT_HDR_PAD); 7180 return -EINVAL; 7181 } 7182 } 7183 7184 /* if a reset is in progress, wait for some time for it to complete */ 7185 do { 7186 if (ice_is_reset_in_progress(pf->state)) { 7187 count++; 7188 usleep_range(1000, 2000); 7189 } else { 7190 break; 7191 } 7192 7193 } while (count < 100); 7194 7195 if (count == 100) { 7196 netdev_err(netdev, "can't change MTU. Device is busy\n"); 7197 return -EBUSY; 7198 } 7199 7200 netdev->mtu = (unsigned int)new_mtu; 7201 7202 /* if VSI is up, bring it down and then back up */ 7203 if (!test_and_set_bit(ICE_VSI_DOWN, vsi->state)) { 7204 err = ice_down(vsi); 7205 if (err) { 7206 netdev_err(netdev, "change MTU if_down err %d\n", err); 7207 return err; 7208 } 7209 7210 err = ice_up(vsi); 7211 if (err) { 7212 netdev_err(netdev, "change MTU if_up err %d\n", err); 7213 return err; 7214 } 7215 } 7216 7217 netdev_dbg(netdev, "changed MTU to %d\n", new_mtu); 7218 set_bit(ICE_FLAG_MTU_CHANGED, pf->flags); 7219 7220 return err; 7221 } 7222 7223 /** 7224 * ice_eth_ioctl - Access the hwtstamp interface 7225 * @netdev: network interface device structure 7226 * @ifr: interface request data 7227 * @cmd: ioctl command 7228 */ 7229 static int ice_eth_ioctl(struct net_device *netdev, struct ifreq *ifr, int cmd) 7230 { 7231 struct ice_netdev_priv *np = netdev_priv(netdev); 7232 struct ice_pf *pf = np->vsi->back; 7233 7234 switch (cmd) { 7235 case SIOCGHWTSTAMP: 7236 return ice_ptp_get_ts_config(pf, ifr); 7237 case SIOCSHWTSTAMP: 7238 return ice_ptp_set_ts_config(pf, ifr); 7239 default: 7240 return -EOPNOTSUPP; 7241 } 7242 } 7243 7244 /** 7245 * ice_aq_str - convert AQ err code to a string 7246 * @aq_err: the AQ error code to convert 7247 */ 7248 const char *ice_aq_str(enum ice_aq_err aq_err) 7249 { 7250 switch (aq_err) { 7251 case ICE_AQ_RC_OK: 7252 return "OK"; 7253 case ICE_AQ_RC_EPERM: 7254 return "ICE_AQ_RC_EPERM"; 7255 case ICE_AQ_RC_ENOENT: 7256 return "ICE_AQ_RC_ENOENT"; 7257 case ICE_AQ_RC_ENOMEM: 7258 return "ICE_AQ_RC_ENOMEM"; 7259 case ICE_AQ_RC_EBUSY: 7260 return "ICE_AQ_RC_EBUSY"; 7261 case ICE_AQ_RC_EEXIST: 7262 return "ICE_AQ_RC_EEXIST"; 7263 case ICE_AQ_RC_EINVAL: 7264 return "ICE_AQ_RC_EINVAL"; 7265 case ICE_AQ_RC_ENOSPC: 7266 return "ICE_AQ_RC_ENOSPC"; 7267 case ICE_AQ_RC_ENOSYS: 7268 return "ICE_AQ_RC_ENOSYS"; 7269 case ICE_AQ_RC_EMODE: 7270 return "ICE_AQ_RC_EMODE"; 7271 case ICE_AQ_RC_ENOSEC: 7272 return "ICE_AQ_RC_ENOSEC"; 7273 case ICE_AQ_RC_EBADSIG: 7274 return "ICE_AQ_RC_EBADSIG"; 7275 case ICE_AQ_RC_ESVN: 7276 return "ICE_AQ_RC_ESVN"; 7277 case ICE_AQ_RC_EBADMAN: 7278 return "ICE_AQ_RC_EBADMAN"; 7279 case ICE_AQ_RC_EBADBUF: 7280 return "ICE_AQ_RC_EBADBUF"; 7281 } 7282 7283 return "ICE_AQ_RC_UNKNOWN"; 7284 } 7285 7286 /** 7287 * ice_set_rss_lut - Set RSS LUT 7288 * @vsi: Pointer to VSI structure 7289 * @lut: Lookup table 7290 * @lut_size: Lookup table size 7291 * 7292 * Returns 0 on success, negative on failure 7293 */ 7294 int ice_set_rss_lut(struct ice_vsi *vsi, u8 *lut, u16 lut_size) 7295 { 7296 struct ice_aq_get_set_rss_lut_params params = {}; 7297 struct ice_hw *hw = &vsi->back->hw; 7298 int status; 7299 7300 if (!lut) 7301 return -EINVAL; 7302 7303 params.vsi_handle = vsi->idx; 7304 params.lut_size = lut_size; 7305 params.lut_type = vsi->rss_lut_type; 7306 params.lut = lut; 7307 7308 status = ice_aq_set_rss_lut(hw, ¶ms); 7309 if (status) 7310 dev_err(ice_pf_to_dev(vsi->back), "Cannot set RSS lut, err %d aq_err %s\n", 7311 status, ice_aq_str(hw->adminq.sq_last_status)); 7312 7313 return status; 7314 } 7315 7316 /** 7317 * ice_set_rss_key - Set RSS key 7318 * @vsi: Pointer to the VSI structure 7319 * @seed: RSS hash seed 7320 * 7321 * Returns 0 on success, negative on failure 7322 */ 7323 int ice_set_rss_key(struct ice_vsi *vsi, u8 *seed) 7324 { 7325 struct ice_hw *hw = &vsi->back->hw; 7326 int status; 7327 7328 if (!seed) 7329 return -EINVAL; 7330 7331 status = ice_aq_set_rss_key(hw, vsi->idx, (struct ice_aqc_get_set_rss_keys *)seed); 7332 if (status) 7333 dev_err(ice_pf_to_dev(vsi->back), "Cannot set RSS key, err %d aq_err %s\n", 7334 status, ice_aq_str(hw->adminq.sq_last_status)); 7335 7336 return status; 7337 } 7338 7339 /** 7340 * ice_get_rss_lut - Get RSS LUT 7341 * @vsi: Pointer to VSI structure 7342 * @lut: Buffer to store the lookup table entries 7343 * @lut_size: Size of buffer to store the lookup table entries 7344 * 7345 * Returns 0 on success, negative on failure 7346 */ 7347 int ice_get_rss_lut(struct ice_vsi *vsi, u8 *lut, u16 lut_size) 7348 { 7349 struct ice_aq_get_set_rss_lut_params params = {}; 7350 struct ice_hw *hw = &vsi->back->hw; 7351 int status; 7352 7353 if (!lut) 7354 return -EINVAL; 7355 7356 params.vsi_handle = vsi->idx; 7357 params.lut_size = lut_size; 7358 params.lut_type = vsi->rss_lut_type; 7359 params.lut = lut; 7360 7361 status = ice_aq_get_rss_lut(hw, ¶ms); 7362 if (status) 7363 dev_err(ice_pf_to_dev(vsi->back), "Cannot get RSS lut, err %d aq_err %s\n", 7364 status, ice_aq_str(hw->adminq.sq_last_status)); 7365 7366 return status; 7367 } 7368 7369 /** 7370 * ice_get_rss_key - Get RSS key 7371 * @vsi: Pointer to VSI structure 7372 * @seed: Buffer to store the key in 7373 * 7374 * Returns 0 on success, negative on failure 7375 */ 7376 int ice_get_rss_key(struct ice_vsi *vsi, u8 *seed) 7377 { 7378 struct ice_hw *hw = &vsi->back->hw; 7379 int status; 7380 7381 if (!seed) 7382 return -EINVAL; 7383 7384 status = ice_aq_get_rss_key(hw, vsi->idx, (struct ice_aqc_get_set_rss_keys *)seed); 7385 if (status) 7386 dev_err(ice_pf_to_dev(vsi->back), "Cannot get RSS key, err %d aq_err %s\n", 7387 status, ice_aq_str(hw->adminq.sq_last_status)); 7388 7389 return status; 7390 } 7391 7392 /** 7393 * ice_bridge_getlink - Get the hardware bridge mode 7394 * @skb: skb buff 7395 * @pid: process ID 7396 * @seq: RTNL message seq 7397 * @dev: the netdev being configured 7398 * @filter_mask: filter mask passed in 7399 * @nlflags: netlink flags passed in 7400 * 7401 * Return the bridge mode (VEB/VEPA) 7402 */ 7403 static int 7404 ice_bridge_getlink(struct sk_buff *skb, u32 pid, u32 seq, 7405 struct net_device *dev, u32 filter_mask, int nlflags) 7406 { 7407 struct ice_netdev_priv *np = netdev_priv(dev); 7408 struct ice_vsi *vsi = np->vsi; 7409 struct ice_pf *pf = vsi->back; 7410 u16 bmode; 7411 7412 bmode = pf->first_sw->bridge_mode; 7413 7414 return ndo_dflt_bridge_getlink(skb, pid, seq, dev, bmode, 0, 0, nlflags, 7415 filter_mask, NULL); 7416 } 7417 7418 /** 7419 * ice_vsi_update_bridge_mode - Update VSI for switching bridge mode (VEB/VEPA) 7420 * @vsi: Pointer to VSI structure 7421 * @bmode: Hardware bridge mode (VEB/VEPA) 7422 * 7423 * Returns 0 on success, negative on failure 7424 */ 7425 static int ice_vsi_update_bridge_mode(struct ice_vsi *vsi, u16 bmode) 7426 { 7427 struct ice_aqc_vsi_props *vsi_props; 7428 struct ice_hw *hw = &vsi->back->hw; 7429 struct ice_vsi_ctx *ctxt; 7430 int ret; 7431 7432 vsi_props = &vsi->info; 7433 7434 ctxt = kzalloc(sizeof(*ctxt), GFP_KERNEL); 7435 if (!ctxt) 7436 return -ENOMEM; 7437 7438 ctxt->info = vsi->info; 7439 7440 if (bmode == BRIDGE_MODE_VEB) 7441 /* change from VEPA to VEB mode */ 7442 ctxt->info.sw_flags |= ICE_AQ_VSI_SW_FLAG_ALLOW_LB; 7443 else 7444 /* change from VEB to VEPA mode */ 7445 ctxt->info.sw_flags &= ~ICE_AQ_VSI_SW_FLAG_ALLOW_LB; 7446 ctxt->info.valid_sections = cpu_to_le16(ICE_AQ_VSI_PROP_SW_VALID); 7447 7448 ret = ice_update_vsi(hw, vsi->idx, ctxt, NULL); 7449 if (ret) { 7450 dev_err(ice_pf_to_dev(vsi->back), "update VSI for bridge mode failed, bmode = %d err %d aq_err %s\n", 7451 bmode, ret, ice_aq_str(hw->adminq.sq_last_status)); 7452 goto out; 7453 } 7454 /* Update sw flags for book keeping */ 7455 vsi_props->sw_flags = ctxt->info.sw_flags; 7456 7457 out: 7458 kfree(ctxt); 7459 return ret; 7460 } 7461 7462 /** 7463 * ice_bridge_setlink - Set the hardware bridge mode 7464 * @dev: the netdev being configured 7465 * @nlh: RTNL message 7466 * @flags: bridge setlink flags 7467 * @extack: netlink extended ack 7468 * 7469 * Sets the bridge mode (VEB/VEPA) of the switch to which the netdev (VSI) is 7470 * hooked up to. Iterates through the PF VSI list and sets the loopback mode (if 7471 * not already set for all VSIs connected to this switch. And also update the 7472 * unicast switch filter rules for the corresponding switch of the netdev. 7473 */ 7474 static int 7475 ice_bridge_setlink(struct net_device *dev, struct nlmsghdr *nlh, 7476 u16 __always_unused flags, 7477 struct netlink_ext_ack __always_unused *extack) 7478 { 7479 struct ice_netdev_priv *np = netdev_priv(dev); 7480 struct ice_pf *pf = np->vsi->back; 7481 struct nlattr *attr, *br_spec; 7482 struct ice_hw *hw = &pf->hw; 7483 struct ice_sw *pf_sw; 7484 int rem, v, err = 0; 7485 7486 pf_sw = pf->first_sw; 7487 /* find the attribute in the netlink message */ 7488 br_spec = nlmsg_find_attr(nlh, sizeof(struct ifinfomsg), IFLA_AF_SPEC); 7489 7490 nla_for_each_nested(attr, br_spec, rem) { 7491 __u16 mode; 7492 7493 if (nla_type(attr) != IFLA_BRIDGE_MODE) 7494 continue; 7495 mode = nla_get_u16(attr); 7496 if (mode != BRIDGE_MODE_VEPA && mode != BRIDGE_MODE_VEB) 7497 return -EINVAL; 7498 /* Continue if bridge mode is not being flipped */ 7499 if (mode == pf_sw->bridge_mode) 7500 continue; 7501 /* Iterates through the PF VSI list and update the loopback 7502 * mode of the VSI 7503 */ 7504 ice_for_each_vsi(pf, v) { 7505 if (!pf->vsi[v]) 7506 continue; 7507 err = ice_vsi_update_bridge_mode(pf->vsi[v], mode); 7508 if (err) 7509 return err; 7510 } 7511 7512 hw->evb_veb = (mode == BRIDGE_MODE_VEB); 7513 /* Update the unicast switch filter rules for the corresponding 7514 * switch of the netdev 7515 */ 7516 err = ice_update_sw_rule_bridge_mode(hw); 7517 if (err) { 7518 netdev_err(dev, "switch rule update failed, mode = %d err %d aq_err %s\n", 7519 mode, err, 7520 ice_aq_str(hw->adminq.sq_last_status)); 7521 /* revert hw->evb_veb */ 7522 hw->evb_veb = (pf_sw->bridge_mode == BRIDGE_MODE_VEB); 7523 return err; 7524 } 7525 7526 pf_sw->bridge_mode = mode; 7527 } 7528 7529 return 0; 7530 } 7531 7532 /** 7533 * ice_tx_timeout - Respond to a Tx Hang 7534 * @netdev: network interface device structure 7535 * @txqueue: Tx queue 7536 */ 7537 static void ice_tx_timeout(struct net_device *netdev, unsigned int txqueue) 7538 { 7539 struct ice_netdev_priv *np = netdev_priv(netdev); 7540 struct ice_tx_ring *tx_ring = NULL; 7541 struct ice_vsi *vsi = np->vsi; 7542 struct ice_pf *pf = vsi->back; 7543 u32 i; 7544 7545 pf->tx_timeout_count++; 7546 7547 /* Check if PFC is enabled for the TC to which the queue belongs 7548 * to. If yes then Tx timeout is not caused by a hung queue, no 7549 * need to reset and rebuild 7550 */ 7551 if (ice_is_pfc_causing_hung_q(pf, txqueue)) { 7552 dev_info(ice_pf_to_dev(pf), "Fake Tx hang detected on queue %u, timeout caused by PFC storm\n", 7553 txqueue); 7554 return; 7555 } 7556 7557 /* now that we have an index, find the tx_ring struct */ 7558 ice_for_each_txq(vsi, i) 7559 if (vsi->tx_rings[i] && vsi->tx_rings[i]->desc) 7560 if (txqueue == vsi->tx_rings[i]->q_index) { 7561 tx_ring = vsi->tx_rings[i]; 7562 break; 7563 } 7564 7565 /* Reset recovery level if enough time has elapsed after last timeout. 7566 * Also ensure no new reset action happens before next timeout period. 7567 */ 7568 if (time_after(jiffies, (pf->tx_timeout_last_recovery + HZ * 20))) 7569 pf->tx_timeout_recovery_level = 1; 7570 else if (time_before(jiffies, (pf->tx_timeout_last_recovery + 7571 netdev->watchdog_timeo))) 7572 return; 7573 7574 if (tx_ring) { 7575 struct ice_hw *hw = &pf->hw; 7576 u32 head, val = 0; 7577 7578 head = (rd32(hw, QTX_COMM_HEAD(vsi->txq_map[txqueue])) & 7579 QTX_COMM_HEAD_HEAD_M) >> QTX_COMM_HEAD_HEAD_S; 7580 /* Read interrupt register */ 7581 val = rd32(hw, GLINT_DYN_CTL(tx_ring->q_vector->reg_idx)); 7582 7583 netdev_info(netdev, "tx_timeout: VSI_num: %d, Q %u, NTC: 0x%x, HW_HEAD: 0x%x, NTU: 0x%x, INT: 0x%x\n", 7584 vsi->vsi_num, txqueue, tx_ring->next_to_clean, 7585 head, tx_ring->next_to_use, val); 7586 } 7587 7588 pf->tx_timeout_last_recovery = jiffies; 7589 netdev_info(netdev, "tx_timeout recovery level %d, txqueue %u\n", 7590 pf->tx_timeout_recovery_level, txqueue); 7591 7592 switch (pf->tx_timeout_recovery_level) { 7593 case 1: 7594 set_bit(ICE_PFR_REQ, pf->state); 7595 break; 7596 case 2: 7597 set_bit(ICE_CORER_REQ, pf->state); 7598 break; 7599 case 3: 7600 set_bit(ICE_GLOBR_REQ, pf->state); 7601 break; 7602 default: 7603 netdev_err(netdev, "tx_timeout recovery unsuccessful, device is in unrecoverable state.\n"); 7604 set_bit(ICE_DOWN, pf->state); 7605 set_bit(ICE_VSI_NEEDS_RESTART, vsi->state); 7606 set_bit(ICE_SERVICE_DIS, pf->state); 7607 break; 7608 } 7609 7610 ice_service_task_schedule(pf); 7611 pf->tx_timeout_recovery_level++; 7612 } 7613 7614 /** 7615 * ice_setup_tc_cls_flower - flower classifier offloads 7616 * @np: net device to configure 7617 * @filter_dev: device on which filter is added 7618 * @cls_flower: offload data 7619 */ 7620 static int 7621 ice_setup_tc_cls_flower(struct ice_netdev_priv *np, 7622 struct net_device *filter_dev, 7623 struct flow_cls_offload *cls_flower) 7624 { 7625 struct ice_vsi *vsi = np->vsi; 7626 7627 if (cls_flower->common.chain_index) 7628 return -EOPNOTSUPP; 7629 7630 switch (cls_flower->command) { 7631 case FLOW_CLS_REPLACE: 7632 return ice_add_cls_flower(filter_dev, vsi, cls_flower); 7633 case FLOW_CLS_DESTROY: 7634 return ice_del_cls_flower(vsi, cls_flower); 7635 default: 7636 return -EINVAL; 7637 } 7638 } 7639 7640 /** 7641 * ice_setup_tc_block_cb - callback handler registered for TC block 7642 * @type: TC SETUP type 7643 * @type_data: TC flower offload data that contains user input 7644 * @cb_priv: netdev private data 7645 */ 7646 static int 7647 ice_setup_tc_block_cb(enum tc_setup_type type, void *type_data, void *cb_priv) 7648 { 7649 struct ice_netdev_priv *np = cb_priv; 7650 7651 switch (type) { 7652 case TC_SETUP_CLSFLOWER: 7653 return ice_setup_tc_cls_flower(np, np->vsi->netdev, 7654 type_data); 7655 default: 7656 return -EOPNOTSUPP; 7657 } 7658 } 7659 7660 /** 7661 * ice_validate_mqprio_qopt - Validate TCF input parameters 7662 * @vsi: Pointer to VSI 7663 * @mqprio_qopt: input parameters for mqprio queue configuration 7664 * 7665 * This function validates MQPRIO params, such as qcount (power of 2 wherever 7666 * needed), and make sure user doesn't specify qcount and BW rate limit 7667 * for TCs, which are more than "num_tc" 7668 */ 7669 static int 7670 ice_validate_mqprio_qopt(struct ice_vsi *vsi, 7671 struct tc_mqprio_qopt_offload *mqprio_qopt) 7672 { 7673 u64 sum_max_rate = 0, sum_min_rate = 0; 7674 int non_power_of_2_qcount = 0; 7675 struct ice_pf *pf = vsi->back; 7676 int max_rss_q_cnt = 0; 7677 struct device *dev; 7678 int i, speed; 7679 u8 num_tc; 7680 7681 if (vsi->type != ICE_VSI_PF) 7682 return -EINVAL; 7683 7684 if (mqprio_qopt->qopt.offset[0] != 0 || 7685 mqprio_qopt->qopt.num_tc < 1 || 7686 mqprio_qopt->qopt.num_tc > ICE_CHNL_MAX_TC) 7687 return -EINVAL; 7688 7689 dev = ice_pf_to_dev(pf); 7690 vsi->ch_rss_size = 0; 7691 num_tc = mqprio_qopt->qopt.num_tc; 7692 7693 for (i = 0; num_tc; i++) { 7694 int qcount = mqprio_qopt->qopt.count[i]; 7695 u64 max_rate, min_rate, rem; 7696 7697 if (!qcount) 7698 return -EINVAL; 7699 7700 if (is_power_of_2(qcount)) { 7701 if (non_power_of_2_qcount && 7702 qcount > non_power_of_2_qcount) { 7703 dev_err(dev, "qcount[%d] cannot be greater than non power of 2 qcount[%d]\n", 7704 qcount, non_power_of_2_qcount); 7705 return -EINVAL; 7706 } 7707 if (qcount > max_rss_q_cnt) 7708 max_rss_q_cnt = qcount; 7709 } else { 7710 if (non_power_of_2_qcount && 7711 qcount != non_power_of_2_qcount) { 7712 dev_err(dev, "Only one non power of 2 qcount allowed[%d,%d]\n", 7713 qcount, non_power_of_2_qcount); 7714 return -EINVAL; 7715 } 7716 if (qcount < max_rss_q_cnt) { 7717 dev_err(dev, "non power of 2 qcount[%d] cannot be less than other qcount[%d]\n", 7718 qcount, max_rss_q_cnt); 7719 return -EINVAL; 7720 } 7721 max_rss_q_cnt = qcount; 7722 non_power_of_2_qcount = qcount; 7723 } 7724 7725 /* TC command takes input in K/N/Gbps or K/M/Gbit etc but 7726 * converts the bandwidth rate limit into Bytes/s when 7727 * passing it down to the driver. So convert input bandwidth 7728 * from Bytes/s to Kbps 7729 */ 7730 max_rate = mqprio_qopt->max_rate[i]; 7731 max_rate = div_u64(max_rate, ICE_BW_KBPS_DIVISOR); 7732 sum_max_rate += max_rate; 7733 7734 /* min_rate is minimum guaranteed rate and it can't be zero */ 7735 min_rate = mqprio_qopt->min_rate[i]; 7736 min_rate = div_u64(min_rate, ICE_BW_KBPS_DIVISOR); 7737 sum_min_rate += min_rate; 7738 7739 if (min_rate && min_rate < ICE_MIN_BW_LIMIT) { 7740 dev_err(dev, "TC%d: min_rate(%llu Kbps) < %u Kbps\n", i, 7741 min_rate, ICE_MIN_BW_LIMIT); 7742 return -EINVAL; 7743 } 7744 7745 iter_div_u64_rem(min_rate, ICE_MIN_BW_LIMIT, &rem); 7746 if (rem) { 7747 dev_err(dev, "TC%d: Min Rate not multiple of %u Kbps", 7748 i, ICE_MIN_BW_LIMIT); 7749 return -EINVAL; 7750 } 7751 7752 iter_div_u64_rem(max_rate, ICE_MIN_BW_LIMIT, &rem); 7753 if (rem) { 7754 dev_err(dev, "TC%d: Max Rate not multiple of %u Kbps", 7755 i, ICE_MIN_BW_LIMIT); 7756 return -EINVAL; 7757 } 7758 7759 /* min_rate can't be more than max_rate, except when max_rate 7760 * is zero (implies max_rate sought is max line rate). In such 7761 * a case min_rate can be more than max. 7762 */ 7763 if (max_rate && min_rate > max_rate) { 7764 dev_err(dev, "min_rate %llu Kbps can't be more than max_rate %llu Kbps\n", 7765 min_rate, max_rate); 7766 return -EINVAL; 7767 } 7768 7769 if (i >= mqprio_qopt->qopt.num_tc - 1) 7770 break; 7771 if (mqprio_qopt->qopt.offset[i + 1] != 7772 (mqprio_qopt->qopt.offset[i] + qcount)) 7773 return -EINVAL; 7774 } 7775 if (vsi->num_rxq < 7776 (mqprio_qopt->qopt.offset[i] + mqprio_qopt->qopt.count[i])) 7777 return -EINVAL; 7778 if (vsi->num_txq < 7779 (mqprio_qopt->qopt.offset[i] + mqprio_qopt->qopt.count[i])) 7780 return -EINVAL; 7781 7782 speed = ice_get_link_speed_kbps(vsi); 7783 if (sum_max_rate && sum_max_rate > (u64)speed) { 7784 dev_err(dev, "Invalid max Tx rate(%llu) Kbps > speed(%u) Kbps specified\n", 7785 sum_max_rate, speed); 7786 return -EINVAL; 7787 } 7788 if (sum_min_rate && sum_min_rate > (u64)speed) { 7789 dev_err(dev, "Invalid min Tx rate(%llu) Kbps > speed (%u) Kbps specified\n", 7790 sum_min_rate, speed); 7791 return -EINVAL; 7792 } 7793 7794 /* make sure vsi->ch_rss_size is set correctly based on TC's qcount */ 7795 vsi->ch_rss_size = max_rss_q_cnt; 7796 7797 return 0; 7798 } 7799 7800 /** 7801 * ice_add_vsi_to_fdir - add a VSI to the flow director group for PF 7802 * @pf: ptr to PF device 7803 * @vsi: ptr to VSI 7804 */ 7805 static int ice_add_vsi_to_fdir(struct ice_pf *pf, struct ice_vsi *vsi) 7806 { 7807 struct device *dev = ice_pf_to_dev(pf); 7808 bool added = false; 7809 struct ice_hw *hw; 7810 int flow; 7811 7812 if (!(vsi->num_gfltr || vsi->num_bfltr)) 7813 return -EINVAL; 7814 7815 hw = &pf->hw; 7816 for (flow = 0; flow < ICE_FLTR_PTYPE_MAX; flow++) { 7817 struct ice_fd_hw_prof *prof; 7818 int tun, status; 7819 u64 entry_h; 7820 7821 if (!(hw->fdir_prof && hw->fdir_prof[flow] && 7822 hw->fdir_prof[flow]->cnt)) 7823 continue; 7824 7825 for (tun = 0; tun < ICE_FD_HW_SEG_MAX; tun++) { 7826 enum ice_flow_priority prio; 7827 u64 prof_id; 7828 7829 /* add this VSI to FDir profile for this flow */ 7830 prio = ICE_FLOW_PRIO_NORMAL; 7831 prof = hw->fdir_prof[flow]; 7832 prof_id = flow + tun * ICE_FLTR_PTYPE_MAX; 7833 status = ice_flow_add_entry(hw, ICE_BLK_FD, prof_id, 7834 prof->vsi_h[0], vsi->idx, 7835 prio, prof->fdir_seg[tun], 7836 &entry_h); 7837 if (status) { 7838 dev_err(dev, "channel VSI idx %d, not able to add to group %d\n", 7839 vsi->idx, flow); 7840 continue; 7841 } 7842 7843 prof->entry_h[prof->cnt][tun] = entry_h; 7844 } 7845 7846 /* store VSI for filter replay and delete */ 7847 prof->vsi_h[prof->cnt] = vsi->idx; 7848 prof->cnt++; 7849 7850 added = true; 7851 dev_dbg(dev, "VSI idx %d added to fdir group %d\n", vsi->idx, 7852 flow); 7853 } 7854 7855 if (!added) 7856 dev_dbg(dev, "VSI idx %d not added to fdir groups\n", vsi->idx); 7857 7858 return 0; 7859 } 7860 7861 /** 7862 * ice_add_channel - add a channel by adding VSI 7863 * @pf: ptr to PF device 7864 * @sw_id: underlying HW switching element ID 7865 * @ch: ptr to channel structure 7866 * 7867 * Add a channel (VSI) using add_vsi and queue_map 7868 */ 7869 static int ice_add_channel(struct ice_pf *pf, u16 sw_id, struct ice_channel *ch) 7870 { 7871 struct device *dev = ice_pf_to_dev(pf); 7872 struct ice_vsi *vsi; 7873 7874 if (ch->type != ICE_VSI_CHNL) { 7875 dev_err(dev, "add new VSI failed, ch->type %d\n", ch->type); 7876 return -EINVAL; 7877 } 7878 7879 vsi = ice_chnl_vsi_setup(pf, pf->hw.port_info, ch); 7880 if (!vsi || vsi->type != ICE_VSI_CHNL) { 7881 dev_err(dev, "create chnl VSI failure\n"); 7882 return -EINVAL; 7883 } 7884 7885 ice_add_vsi_to_fdir(pf, vsi); 7886 7887 ch->sw_id = sw_id; 7888 ch->vsi_num = vsi->vsi_num; 7889 ch->info.mapping_flags = vsi->info.mapping_flags; 7890 ch->ch_vsi = vsi; 7891 /* set the back pointer of channel for newly created VSI */ 7892 vsi->ch = ch; 7893 7894 memcpy(&ch->info.q_mapping, &vsi->info.q_mapping, 7895 sizeof(vsi->info.q_mapping)); 7896 memcpy(&ch->info.tc_mapping, vsi->info.tc_mapping, 7897 sizeof(vsi->info.tc_mapping)); 7898 7899 return 0; 7900 } 7901 7902 /** 7903 * ice_chnl_cfg_res 7904 * @vsi: the VSI being setup 7905 * @ch: ptr to channel structure 7906 * 7907 * Configure channel specific resources such as rings, vector. 7908 */ 7909 static void ice_chnl_cfg_res(struct ice_vsi *vsi, struct ice_channel *ch) 7910 { 7911 int i; 7912 7913 for (i = 0; i < ch->num_txq; i++) { 7914 struct ice_q_vector *tx_q_vector, *rx_q_vector; 7915 struct ice_ring_container *rc; 7916 struct ice_tx_ring *tx_ring; 7917 struct ice_rx_ring *rx_ring; 7918 7919 tx_ring = vsi->tx_rings[ch->base_q + i]; 7920 rx_ring = vsi->rx_rings[ch->base_q + i]; 7921 if (!tx_ring || !rx_ring) 7922 continue; 7923 7924 /* setup ring being channel enabled */ 7925 tx_ring->ch = ch; 7926 rx_ring->ch = ch; 7927 7928 /* following code block sets up vector specific attributes */ 7929 tx_q_vector = tx_ring->q_vector; 7930 rx_q_vector = rx_ring->q_vector; 7931 if (!tx_q_vector && !rx_q_vector) 7932 continue; 7933 7934 if (tx_q_vector) { 7935 tx_q_vector->ch = ch; 7936 /* setup Tx and Rx ITR setting if DIM is off */ 7937 rc = &tx_q_vector->tx; 7938 if (!ITR_IS_DYNAMIC(rc)) 7939 ice_write_itr(rc, rc->itr_setting); 7940 } 7941 if (rx_q_vector) { 7942 rx_q_vector->ch = ch; 7943 /* setup Tx and Rx ITR setting if DIM is off */ 7944 rc = &rx_q_vector->rx; 7945 if (!ITR_IS_DYNAMIC(rc)) 7946 ice_write_itr(rc, rc->itr_setting); 7947 } 7948 } 7949 7950 /* it is safe to assume that, if channel has non-zero num_t[r]xq, then 7951 * GLINT_ITR register would have written to perform in-context 7952 * update, hence perform flush 7953 */ 7954 if (ch->num_txq || ch->num_rxq) 7955 ice_flush(&vsi->back->hw); 7956 } 7957 7958 /** 7959 * ice_cfg_chnl_all_res - configure channel resources 7960 * @vsi: pte to main_vsi 7961 * @ch: ptr to channel structure 7962 * 7963 * This function configures channel specific resources such as flow-director 7964 * counter index, and other resources such as queues, vectors, ITR settings 7965 */ 7966 static void 7967 ice_cfg_chnl_all_res(struct ice_vsi *vsi, struct ice_channel *ch) 7968 { 7969 /* configure channel (aka ADQ) resources such as queues, vectors, 7970 * ITR settings for channel specific vectors and anything else 7971 */ 7972 ice_chnl_cfg_res(vsi, ch); 7973 } 7974 7975 /** 7976 * ice_setup_hw_channel - setup new channel 7977 * @pf: ptr to PF device 7978 * @vsi: the VSI being setup 7979 * @ch: ptr to channel structure 7980 * @sw_id: underlying HW switching element ID 7981 * @type: type of channel to be created (VMDq2/VF) 7982 * 7983 * Setup new channel (VSI) based on specified type (VMDq2/VF) 7984 * and configures Tx rings accordingly 7985 */ 7986 static int 7987 ice_setup_hw_channel(struct ice_pf *pf, struct ice_vsi *vsi, 7988 struct ice_channel *ch, u16 sw_id, u8 type) 7989 { 7990 struct device *dev = ice_pf_to_dev(pf); 7991 int ret; 7992 7993 ch->base_q = vsi->next_base_q; 7994 ch->type = type; 7995 7996 ret = ice_add_channel(pf, sw_id, ch); 7997 if (ret) { 7998 dev_err(dev, "failed to add_channel using sw_id %u\n", sw_id); 7999 return ret; 8000 } 8001 8002 /* configure/setup ADQ specific resources */ 8003 ice_cfg_chnl_all_res(vsi, ch); 8004 8005 /* make sure to update the next_base_q so that subsequent channel's 8006 * (aka ADQ) VSI queue map is correct 8007 */ 8008 vsi->next_base_q = vsi->next_base_q + ch->num_rxq; 8009 dev_dbg(dev, "added channel: vsi_num %u, num_rxq %u\n", ch->vsi_num, 8010 ch->num_rxq); 8011 8012 return 0; 8013 } 8014 8015 /** 8016 * ice_setup_channel - setup new channel using uplink element 8017 * @pf: ptr to PF device 8018 * @vsi: the VSI being setup 8019 * @ch: ptr to channel structure 8020 * 8021 * Setup new channel (VSI) based on specified type (VMDq2/VF) 8022 * and uplink switching element 8023 */ 8024 static bool 8025 ice_setup_channel(struct ice_pf *pf, struct ice_vsi *vsi, 8026 struct ice_channel *ch) 8027 { 8028 struct device *dev = ice_pf_to_dev(pf); 8029 u16 sw_id; 8030 int ret; 8031 8032 if (vsi->type != ICE_VSI_PF) { 8033 dev_err(dev, "unsupported parent VSI type(%d)\n", vsi->type); 8034 return false; 8035 } 8036 8037 sw_id = pf->first_sw->sw_id; 8038 8039 /* create channel (VSI) */ 8040 ret = ice_setup_hw_channel(pf, vsi, ch, sw_id, ICE_VSI_CHNL); 8041 if (ret) { 8042 dev_err(dev, "failed to setup hw_channel\n"); 8043 return false; 8044 } 8045 dev_dbg(dev, "successfully created channel()\n"); 8046 8047 return ch->ch_vsi ? true : false; 8048 } 8049 8050 /** 8051 * ice_set_bw_limit - setup BW limit for Tx traffic based on max_tx_rate 8052 * @vsi: VSI to be configured 8053 * @max_tx_rate: max Tx rate in Kbps to be configured as maximum BW limit 8054 * @min_tx_rate: min Tx rate in Kbps to be configured as minimum BW limit 8055 */ 8056 static int 8057 ice_set_bw_limit(struct ice_vsi *vsi, u64 max_tx_rate, u64 min_tx_rate) 8058 { 8059 int err; 8060 8061 err = ice_set_min_bw_limit(vsi, min_tx_rate); 8062 if (err) 8063 return err; 8064 8065 return ice_set_max_bw_limit(vsi, max_tx_rate); 8066 } 8067 8068 /** 8069 * ice_create_q_channel - function to create channel 8070 * @vsi: VSI to be configured 8071 * @ch: ptr to channel (it contains channel specific params) 8072 * 8073 * This function creates channel (VSI) using num_queues specified by user, 8074 * reconfigs RSS if needed. 8075 */ 8076 static int ice_create_q_channel(struct ice_vsi *vsi, struct ice_channel *ch) 8077 { 8078 struct ice_pf *pf = vsi->back; 8079 struct device *dev; 8080 8081 if (!ch) 8082 return -EINVAL; 8083 8084 dev = ice_pf_to_dev(pf); 8085 if (!ch->num_txq || !ch->num_rxq) { 8086 dev_err(dev, "Invalid num_queues requested: %d\n", ch->num_rxq); 8087 return -EINVAL; 8088 } 8089 8090 if (!vsi->cnt_q_avail || vsi->cnt_q_avail < ch->num_txq) { 8091 dev_err(dev, "cnt_q_avail (%u) less than num_queues %d\n", 8092 vsi->cnt_q_avail, ch->num_txq); 8093 return -EINVAL; 8094 } 8095 8096 if (!ice_setup_channel(pf, vsi, ch)) { 8097 dev_info(dev, "Failed to setup channel\n"); 8098 return -EINVAL; 8099 } 8100 /* configure BW rate limit */ 8101 if (ch->ch_vsi && (ch->max_tx_rate || ch->min_tx_rate)) { 8102 int ret; 8103 8104 ret = ice_set_bw_limit(ch->ch_vsi, ch->max_tx_rate, 8105 ch->min_tx_rate); 8106 if (ret) 8107 dev_err(dev, "failed to set Tx rate of %llu Kbps for VSI(%u)\n", 8108 ch->max_tx_rate, ch->ch_vsi->vsi_num); 8109 else 8110 dev_dbg(dev, "set Tx rate of %llu Kbps for VSI(%u)\n", 8111 ch->max_tx_rate, ch->ch_vsi->vsi_num); 8112 } 8113 8114 vsi->cnt_q_avail -= ch->num_txq; 8115 8116 return 0; 8117 } 8118 8119 /** 8120 * ice_rem_all_chnl_fltrs - removes all channel filters 8121 * @pf: ptr to PF, TC-flower based filter are tracked at PF level 8122 * 8123 * Remove all advanced switch filters only if they are channel specific 8124 * tc-flower based filter 8125 */ 8126 static void ice_rem_all_chnl_fltrs(struct ice_pf *pf) 8127 { 8128 struct ice_tc_flower_fltr *fltr; 8129 struct hlist_node *node; 8130 8131 /* to remove all channel filters, iterate an ordered list of filters */ 8132 hlist_for_each_entry_safe(fltr, node, 8133 &pf->tc_flower_fltr_list, 8134 tc_flower_node) { 8135 struct ice_rule_query_data rule; 8136 int status; 8137 8138 /* for now process only channel specific filters */ 8139 if (!ice_is_chnl_fltr(fltr)) 8140 continue; 8141 8142 rule.rid = fltr->rid; 8143 rule.rule_id = fltr->rule_id; 8144 rule.vsi_handle = fltr->dest_id; 8145 status = ice_rem_adv_rule_by_id(&pf->hw, &rule); 8146 if (status) { 8147 if (status == -ENOENT) 8148 dev_dbg(ice_pf_to_dev(pf), "TC flower filter (rule_id %u) does not exist\n", 8149 rule.rule_id); 8150 else 8151 dev_err(ice_pf_to_dev(pf), "failed to delete TC flower filter, status %d\n", 8152 status); 8153 } else if (fltr->dest_vsi) { 8154 /* update advanced switch filter count */ 8155 if (fltr->dest_vsi->type == ICE_VSI_CHNL) { 8156 u32 flags = fltr->flags; 8157 8158 fltr->dest_vsi->num_chnl_fltr--; 8159 if (flags & (ICE_TC_FLWR_FIELD_DST_MAC | 8160 ICE_TC_FLWR_FIELD_ENC_DST_MAC)) 8161 pf->num_dmac_chnl_fltrs--; 8162 } 8163 } 8164 8165 hlist_del(&fltr->tc_flower_node); 8166 kfree(fltr); 8167 } 8168 } 8169 8170 /** 8171 * ice_remove_q_channels - Remove queue channels for the TCs 8172 * @vsi: VSI to be configured 8173 * @rem_fltr: delete advanced switch filter or not 8174 * 8175 * Remove queue channels for the TCs 8176 */ 8177 static void ice_remove_q_channels(struct ice_vsi *vsi, bool rem_fltr) 8178 { 8179 struct ice_channel *ch, *ch_tmp; 8180 struct ice_pf *pf = vsi->back; 8181 int i; 8182 8183 /* remove all tc-flower based filter if they are channel filters only */ 8184 if (rem_fltr) 8185 ice_rem_all_chnl_fltrs(pf); 8186 8187 /* remove ntuple filters since queue configuration is being changed */ 8188 if (vsi->netdev->features & NETIF_F_NTUPLE) { 8189 struct ice_hw *hw = &pf->hw; 8190 8191 mutex_lock(&hw->fdir_fltr_lock); 8192 ice_fdir_del_all_fltrs(vsi); 8193 mutex_unlock(&hw->fdir_fltr_lock); 8194 } 8195 8196 /* perform cleanup for channels if they exist */ 8197 list_for_each_entry_safe(ch, ch_tmp, &vsi->ch_list, list) { 8198 struct ice_vsi *ch_vsi; 8199 8200 list_del(&ch->list); 8201 ch_vsi = ch->ch_vsi; 8202 if (!ch_vsi) { 8203 kfree(ch); 8204 continue; 8205 } 8206 8207 /* Reset queue contexts */ 8208 for (i = 0; i < ch->num_rxq; i++) { 8209 struct ice_tx_ring *tx_ring; 8210 struct ice_rx_ring *rx_ring; 8211 8212 tx_ring = vsi->tx_rings[ch->base_q + i]; 8213 rx_ring = vsi->rx_rings[ch->base_q + i]; 8214 if (tx_ring) { 8215 tx_ring->ch = NULL; 8216 if (tx_ring->q_vector) 8217 tx_ring->q_vector->ch = NULL; 8218 } 8219 if (rx_ring) { 8220 rx_ring->ch = NULL; 8221 if (rx_ring->q_vector) 8222 rx_ring->q_vector->ch = NULL; 8223 } 8224 } 8225 8226 /* Release FD resources for the channel VSI */ 8227 ice_fdir_rem_adq_chnl(&pf->hw, ch->ch_vsi->idx); 8228 8229 /* clear the VSI from scheduler tree */ 8230 ice_rm_vsi_lan_cfg(ch->ch_vsi->port_info, ch->ch_vsi->idx); 8231 8232 /* Delete VSI from FW */ 8233 ice_vsi_delete(ch->ch_vsi); 8234 8235 /* Delete VSI from PF and HW VSI arrays */ 8236 ice_vsi_clear(ch->ch_vsi); 8237 8238 /* free the channel */ 8239 kfree(ch); 8240 } 8241 8242 /* clear the channel VSI map which is stored in main VSI */ 8243 ice_for_each_chnl_tc(i) 8244 vsi->tc_map_vsi[i] = NULL; 8245 8246 /* reset main VSI's all TC information */ 8247 vsi->all_enatc = 0; 8248 vsi->all_numtc = 0; 8249 } 8250 8251 /** 8252 * ice_rebuild_channels - rebuild channel 8253 * @pf: ptr to PF 8254 * 8255 * Recreate channel VSIs and replay filters 8256 */ 8257 static int ice_rebuild_channels(struct ice_pf *pf) 8258 { 8259 struct device *dev = ice_pf_to_dev(pf); 8260 struct ice_vsi *main_vsi; 8261 bool rem_adv_fltr = true; 8262 struct ice_channel *ch; 8263 struct ice_vsi *vsi; 8264 int tc_idx = 1; 8265 int i, err; 8266 8267 main_vsi = ice_get_main_vsi(pf); 8268 if (!main_vsi) 8269 return 0; 8270 8271 if (!test_bit(ICE_FLAG_TC_MQPRIO, pf->flags) || 8272 main_vsi->old_numtc == 1) 8273 return 0; /* nothing to be done */ 8274 8275 /* reconfigure main VSI based on old value of TC and cached values 8276 * for MQPRIO opts 8277 */ 8278 err = ice_vsi_cfg_tc(main_vsi, main_vsi->old_ena_tc); 8279 if (err) { 8280 dev_err(dev, "failed configuring TC(ena_tc:0x%02x) for HW VSI=%u\n", 8281 main_vsi->old_ena_tc, main_vsi->vsi_num); 8282 return err; 8283 } 8284 8285 /* rebuild ADQ VSIs */ 8286 ice_for_each_vsi(pf, i) { 8287 enum ice_vsi_type type; 8288 8289 vsi = pf->vsi[i]; 8290 if (!vsi || vsi->type != ICE_VSI_CHNL) 8291 continue; 8292 8293 type = vsi->type; 8294 8295 /* rebuild ADQ VSI */ 8296 err = ice_vsi_rebuild(vsi, true); 8297 if (err) { 8298 dev_err(dev, "VSI (type:%s) at index %d rebuild failed, err %d\n", 8299 ice_vsi_type_str(type), vsi->idx, err); 8300 goto cleanup; 8301 } 8302 8303 /* Re-map HW VSI number, using VSI handle that has been 8304 * previously validated in ice_replay_vsi() call above 8305 */ 8306 vsi->vsi_num = ice_get_hw_vsi_num(&pf->hw, vsi->idx); 8307 8308 /* replay filters for the VSI */ 8309 err = ice_replay_vsi(&pf->hw, vsi->idx); 8310 if (err) { 8311 dev_err(dev, "VSI (type:%s) replay failed, err %d, VSI index %d\n", 8312 ice_vsi_type_str(type), err, vsi->idx); 8313 rem_adv_fltr = false; 8314 goto cleanup; 8315 } 8316 dev_info(dev, "VSI (type:%s) at index %d rebuilt successfully\n", 8317 ice_vsi_type_str(type), vsi->idx); 8318 8319 /* store ADQ VSI at correct TC index in main VSI's 8320 * map of TC to VSI 8321 */ 8322 main_vsi->tc_map_vsi[tc_idx++] = vsi; 8323 } 8324 8325 /* ADQ VSI(s) has been rebuilt successfully, so setup 8326 * channel for main VSI's Tx and Rx rings 8327 */ 8328 list_for_each_entry(ch, &main_vsi->ch_list, list) { 8329 struct ice_vsi *ch_vsi; 8330 8331 ch_vsi = ch->ch_vsi; 8332 if (!ch_vsi) 8333 continue; 8334 8335 /* reconfig channel resources */ 8336 ice_cfg_chnl_all_res(main_vsi, ch); 8337 8338 /* replay BW rate limit if it is non-zero */ 8339 if (!ch->max_tx_rate && !ch->min_tx_rate) 8340 continue; 8341 8342 err = ice_set_bw_limit(ch_vsi, ch->max_tx_rate, 8343 ch->min_tx_rate); 8344 if (err) 8345 dev_err(dev, "failed (err:%d) to rebuild BW rate limit, max_tx_rate: %llu Kbps, min_tx_rate: %llu Kbps for VSI(%u)\n", 8346 err, ch->max_tx_rate, ch->min_tx_rate, 8347 ch_vsi->vsi_num); 8348 else 8349 dev_dbg(dev, "successfully rebuild BW rate limit, max_tx_rate: %llu Kbps, min_tx_rate: %llu Kbps for VSI(%u)\n", 8350 ch->max_tx_rate, ch->min_tx_rate, 8351 ch_vsi->vsi_num); 8352 } 8353 8354 /* reconfig RSS for main VSI */ 8355 if (main_vsi->ch_rss_size) 8356 ice_vsi_cfg_rss_lut_key(main_vsi); 8357 8358 return 0; 8359 8360 cleanup: 8361 ice_remove_q_channels(main_vsi, rem_adv_fltr); 8362 return err; 8363 } 8364 8365 /** 8366 * ice_create_q_channels - Add queue channel for the given TCs 8367 * @vsi: VSI to be configured 8368 * 8369 * Configures queue channel mapping to the given TCs 8370 */ 8371 static int ice_create_q_channels(struct ice_vsi *vsi) 8372 { 8373 struct ice_pf *pf = vsi->back; 8374 struct ice_channel *ch; 8375 int ret = 0, i; 8376 8377 ice_for_each_chnl_tc(i) { 8378 if (!(vsi->all_enatc & BIT(i))) 8379 continue; 8380 8381 ch = kzalloc(sizeof(*ch), GFP_KERNEL); 8382 if (!ch) { 8383 ret = -ENOMEM; 8384 goto err_free; 8385 } 8386 INIT_LIST_HEAD(&ch->list); 8387 ch->num_rxq = vsi->mqprio_qopt.qopt.count[i]; 8388 ch->num_txq = vsi->mqprio_qopt.qopt.count[i]; 8389 ch->base_q = vsi->mqprio_qopt.qopt.offset[i]; 8390 ch->max_tx_rate = vsi->mqprio_qopt.max_rate[i]; 8391 ch->min_tx_rate = vsi->mqprio_qopt.min_rate[i]; 8392 8393 /* convert to Kbits/s */ 8394 if (ch->max_tx_rate) 8395 ch->max_tx_rate = div_u64(ch->max_tx_rate, 8396 ICE_BW_KBPS_DIVISOR); 8397 if (ch->min_tx_rate) 8398 ch->min_tx_rate = div_u64(ch->min_tx_rate, 8399 ICE_BW_KBPS_DIVISOR); 8400 8401 ret = ice_create_q_channel(vsi, ch); 8402 if (ret) { 8403 dev_err(ice_pf_to_dev(pf), 8404 "failed creating channel TC:%d\n", i); 8405 kfree(ch); 8406 goto err_free; 8407 } 8408 list_add_tail(&ch->list, &vsi->ch_list); 8409 vsi->tc_map_vsi[i] = ch->ch_vsi; 8410 dev_dbg(ice_pf_to_dev(pf), 8411 "successfully created channel: VSI %pK\n", ch->ch_vsi); 8412 } 8413 return 0; 8414 8415 err_free: 8416 ice_remove_q_channels(vsi, false); 8417 8418 return ret; 8419 } 8420 8421 /** 8422 * ice_setup_tc_mqprio_qdisc - configure multiple traffic classes 8423 * @netdev: net device to configure 8424 * @type_data: TC offload data 8425 */ 8426 static int ice_setup_tc_mqprio_qdisc(struct net_device *netdev, void *type_data) 8427 { 8428 struct tc_mqprio_qopt_offload *mqprio_qopt = type_data; 8429 struct ice_netdev_priv *np = netdev_priv(netdev); 8430 struct ice_vsi *vsi = np->vsi; 8431 struct ice_pf *pf = vsi->back; 8432 u16 mode, ena_tc_qdisc = 0; 8433 int cur_txq, cur_rxq; 8434 u8 hw = 0, num_tcf; 8435 struct device *dev; 8436 int ret, i; 8437 8438 dev = ice_pf_to_dev(pf); 8439 num_tcf = mqprio_qopt->qopt.num_tc; 8440 hw = mqprio_qopt->qopt.hw; 8441 mode = mqprio_qopt->mode; 8442 if (!hw) { 8443 clear_bit(ICE_FLAG_TC_MQPRIO, pf->flags); 8444 vsi->ch_rss_size = 0; 8445 memcpy(&vsi->mqprio_qopt, mqprio_qopt, sizeof(*mqprio_qopt)); 8446 goto config_tcf; 8447 } 8448 8449 /* Generate queue region map for number of TCF requested */ 8450 for (i = 0; i < num_tcf; i++) 8451 ena_tc_qdisc |= BIT(i); 8452 8453 switch (mode) { 8454 case TC_MQPRIO_MODE_CHANNEL: 8455 8456 ret = ice_validate_mqprio_qopt(vsi, mqprio_qopt); 8457 if (ret) { 8458 netdev_err(netdev, "failed to validate_mqprio_qopt(), ret %d\n", 8459 ret); 8460 return ret; 8461 } 8462 memcpy(&vsi->mqprio_qopt, mqprio_qopt, sizeof(*mqprio_qopt)); 8463 set_bit(ICE_FLAG_TC_MQPRIO, pf->flags); 8464 /* don't assume state of hw_tc_offload during driver load 8465 * and set the flag for TC flower filter if hw_tc_offload 8466 * already ON 8467 */ 8468 if (vsi->netdev->features & NETIF_F_HW_TC) 8469 set_bit(ICE_FLAG_CLS_FLOWER, pf->flags); 8470 break; 8471 default: 8472 return -EINVAL; 8473 } 8474 8475 config_tcf: 8476 8477 /* Requesting same TCF configuration as already enabled */ 8478 if (ena_tc_qdisc == vsi->tc_cfg.ena_tc && 8479 mode != TC_MQPRIO_MODE_CHANNEL) 8480 return 0; 8481 8482 /* Pause VSI queues */ 8483 ice_dis_vsi(vsi, true); 8484 8485 if (!hw && !test_bit(ICE_FLAG_TC_MQPRIO, pf->flags)) 8486 ice_remove_q_channels(vsi, true); 8487 8488 if (!hw && !test_bit(ICE_FLAG_TC_MQPRIO, pf->flags)) { 8489 vsi->req_txq = min_t(int, ice_get_avail_txq_count(pf), 8490 num_online_cpus()); 8491 vsi->req_rxq = min_t(int, ice_get_avail_rxq_count(pf), 8492 num_online_cpus()); 8493 } else { 8494 /* logic to rebuild VSI, same like ethtool -L */ 8495 u16 offset = 0, qcount_tx = 0, qcount_rx = 0; 8496 8497 for (i = 0; i < num_tcf; i++) { 8498 if (!(ena_tc_qdisc & BIT(i))) 8499 continue; 8500 8501 offset = vsi->mqprio_qopt.qopt.offset[i]; 8502 qcount_rx = vsi->mqprio_qopt.qopt.count[i]; 8503 qcount_tx = vsi->mqprio_qopt.qopt.count[i]; 8504 } 8505 vsi->req_txq = offset + qcount_tx; 8506 vsi->req_rxq = offset + qcount_rx; 8507 8508 /* store away original rss_size info, so that it gets reused 8509 * form ice_vsi_rebuild during tc-qdisc delete stage - to 8510 * determine, what should be the rss_sizefor main VSI 8511 */ 8512 vsi->orig_rss_size = vsi->rss_size; 8513 } 8514 8515 /* save current values of Tx and Rx queues before calling VSI rebuild 8516 * for fallback option 8517 */ 8518 cur_txq = vsi->num_txq; 8519 cur_rxq = vsi->num_rxq; 8520 8521 /* proceed with rebuild main VSI using correct number of queues */ 8522 ret = ice_vsi_rebuild(vsi, false); 8523 if (ret) { 8524 /* fallback to current number of queues */ 8525 dev_info(dev, "Rebuild failed with new queues, try with current number of queues\n"); 8526 vsi->req_txq = cur_txq; 8527 vsi->req_rxq = cur_rxq; 8528 clear_bit(ICE_RESET_FAILED, pf->state); 8529 if (ice_vsi_rebuild(vsi, false)) { 8530 dev_err(dev, "Rebuild of main VSI failed again\n"); 8531 return ret; 8532 } 8533 } 8534 8535 vsi->all_numtc = num_tcf; 8536 vsi->all_enatc = ena_tc_qdisc; 8537 ret = ice_vsi_cfg_tc(vsi, ena_tc_qdisc); 8538 if (ret) { 8539 netdev_err(netdev, "failed configuring TC for VSI id=%d\n", 8540 vsi->vsi_num); 8541 goto exit; 8542 } 8543 8544 if (test_bit(ICE_FLAG_TC_MQPRIO, pf->flags)) { 8545 u64 max_tx_rate = vsi->mqprio_qopt.max_rate[0]; 8546 u64 min_tx_rate = vsi->mqprio_qopt.min_rate[0]; 8547 8548 /* set TC0 rate limit if specified */ 8549 if (max_tx_rate || min_tx_rate) { 8550 /* convert to Kbits/s */ 8551 if (max_tx_rate) 8552 max_tx_rate = div_u64(max_tx_rate, ICE_BW_KBPS_DIVISOR); 8553 if (min_tx_rate) 8554 min_tx_rate = div_u64(min_tx_rate, ICE_BW_KBPS_DIVISOR); 8555 8556 ret = ice_set_bw_limit(vsi, max_tx_rate, min_tx_rate); 8557 if (!ret) { 8558 dev_dbg(dev, "set Tx rate max %llu min %llu for VSI(%u)\n", 8559 max_tx_rate, min_tx_rate, vsi->vsi_num); 8560 } else { 8561 dev_err(dev, "failed to set Tx rate max %llu min %llu for VSI(%u)\n", 8562 max_tx_rate, min_tx_rate, vsi->vsi_num); 8563 goto exit; 8564 } 8565 } 8566 ret = ice_create_q_channels(vsi); 8567 if (ret) { 8568 netdev_err(netdev, "failed configuring queue channels\n"); 8569 goto exit; 8570 } else { 8571 netdev_dbg(netdev, "successfully configured channels\n"); 8572 } 8573 } 8574 8575 if (vsi->ch_rss_size) 8576 ice_vsi_cfg_rss_lut_key(vsi); 8577 8578 exit: 8579 /* if error, reset the all_numtc and all_enatc */ 8580 if (ret) { 8581 vsi->all_numtc = 0; 8582 vsi->all_enatc = 0; 8583 } 8584 /* resume VSI */ 8585 ice_ena_vsi(vsi, true); 8586 8587 return ret; 8588 } 8589 8590 static LIST_HEAD(ice_block_cb_list); 8591 8592 static int 8593 ice_setup_tc(struct net_device *netdev, enum tc_setup_type type, 8594 void *type_data) 8595 { 8596 struct ice_netdev_priv *np = netdev_priv(netdev); 8597 struct ice_pf *pf = np->vsi->back; 8598 int err; 8599 8600 switch (type) { 8601 case TC_SETUP_BLOCK: 8602 return flow_block_cb_setup_simple(type_data, 8603 &ice_block_cb_list, 8604 ice_setup_tc_block_cb, 8605 np, np, true); 8606 case TC_SETUP_QDISC_MQPRIO: 8607 /* setup traffic classifier for receive side */ 8608 mutex_lock(&pf->tc_mutex); 8609 err = ice_setup_tc_mqprio_qdisc(netdev, type_data); 8610 mutex_unlock(&pf->tc_mutex); 8611 return err; 8612 default: 8613 return -EOPNOTSUPP; 8614 } 8615 return -EOPNOTSUPP; 8616 } 8617 8618 static struct ice_indr_block_priv * 8619 ice_indr_block_priv_lookup(struct ice_netdev_priv *np, 8620 struct net_device *netdev) 8621 { 8622 struct ice_indr_block_priv *cb_priv; 8623 8624 list_for_each_entry(cb_priv, &np->tc_indr_block_priv_list, list) { 8625 if (!cb_priv->netdev) 8626 return NULL; 8627 if (cb_priv->netdev == netdev) 8628 return cb_priv; 8629 } 8630 return NULL; 8631 } 8632 8633 static int 8634 ice_indr_setup_block_cb(enum tc_setup_type type, void *type_data, 8635 void *indr_priv) 8636 { 8637 struct ice_indr_block_priv *priv = indr_priv; 8638 struct ice_netdev_priv *np = priv->np; 8639 8640 switch (type) { 8641 case TC_SETUP_CLSFLOWER: 8642 return ice_setup_tc_cls_flower(np, priv->netdev, 8643 (struct flow_cls_offload *) 8644 type_data); 8645 default: 8646 return -EOPNOTSUPP; 8647 } 8648 } 8649 8650 static int 8651 ice_indr_setup_tc_block(struct net_device *netdev, struct Qdisc *sch, 8652 struct ice_netdev_priv *np, 8653 struct flow_block_offload *f, void *data, 8654 void (*cleanup)(struct flow_block_cb *block_cb)) 8655 { 8656 struct ice_indr_block_priv *indr_priv; 8657 struct flow_block_cb *block_cb; 8658 8659 if (!ice_is_tunnel_supported(netdev) && 8660 !(is_vlan_dev(netdev) && 8661 vlan_dev_real_dev(netdev) == np->vsi->netdev)) 8662 return -EOPNOTSUPP; 8663 8664 if (f->binder_type != FLOW_BLOCK_BINDER_TYPE_CLSACT_INGRESS) 8665 return -EOPNOTSUPP; 8666 8667 switch (f->command) { 8668 case FLOW_BLOCK_BIND: 8669 indr_priv = ice_indr_block_priv_lookup(np, netdev); 8670 if (indr_priv) 8671 return -EEXIST; 8672 8673 indr_priv = kzalloc(sizeof(*indr_priv), GFP_KERNEL); 8674 if (!indr_priv) 8675 return -ENOMEM; 8676 8677 indr_priv->netdev = netdev; 8678 indr_priv->np = np; 8679 list_add(&indr_priv->list, &np->tc_indr_block_priv_list); 8680 8681 block_cb = 8682 flow_indr_block_cb_alloc(ice_indr_setup_block_cb, 8683 indr_priv, indr_priv, 8684 ice_rep_indr_tc_block_unbind, 8685 f, netdev, sch, data, np, 8686 cleanup); 8687 8688 if (IS_ERR(block_cb)) { 8689 list_del(&indr_priv->list); 8690 kfree(indr_priv); 8691 return PTR_ERR(block_cb); 8692 } 8693 flow_block_cb_add(block_cb, f); 8694 list_add_tail(&block_cb->driver_list, &ice_block_cb_list); 8695 break; 8696 case FLOW_BLOCK_UNBIND: 8697 indr_priv = ice_indr_block_priv_lookup(np, netdev); 8698 if (!indr_priv) 8699 return -ENOENT; 8700 8701 block_cb = flow_block_cb_lookup(f->block, 8702 ice_indr_setup_block_cb, 8703 indr_priv); 8704 if (!block_cb) 8705 return -ENOENT; 8706 8707 flow_indr_block_cb_remove(block_cb, f); 8708 8709 list_del(&block_cb->driver_list); 8710 break; 8711 default: 8712 return -EOPNOTSUPP; 8713 } 8714 return 0; 8715 } 8716 8717 static int 8718 ice_indr_setup_tc_cb(struct net_device *netdev, struct Qdisc *sch, 8719 void *cb_priv, enum tc_setup_type type, void *type_data, 8720 void *data, 8721 void (*cleanup)(struct flow_block_cb *block_cb)) 8722 { 8723 switch (type) { 8724 case TC_SETUP_BLOCK: 8725 return ice_indr_setup_tc_block(netdev, sch, cb_priv, type_data, 8726 data, cleanup); 8727 8728 default: 8729 return -EOPNOTSUPP; 8730 } 8731 } 8732 8733 /** 8734 * ice_open - Called when a network interface becomes active 8735 * @netdev: network interface device structure 8736 * 8737 * The open entry point is called when a network interface is made 8738 * active by the system (IFF_UP). At this point all resources needed 8739 * for transmit and receive operations are allocated, the interrupt 8740 * handler is registered with the OS, the netdev watchdog is enabled, 8741 * and the stack is notified that the interface is ready. 8742 * 8743 * Returns 0 on success, negative value on failure 8744 */ 8745 int ice_open(struct net_device *netdev) 8746 { 8747 struct ice_netdev_priv *np = netdev_priv(netdev); 8748 struct ice_pf *pf = np->vsi->back; 8749 8750 if (ice_is_reset_in_progress(pf->state)) { 8751 netdev_err(netdev, "can't open net device while reset is in progress"); 8752 return -EBUSY; 8753 } 8754 8755 return ice_open_internal(netdev); 8756 } 8757 8758 /** 8759 * ice_open_internal - Called when a network interface becomes active 8760 * @netdev: network interface device structure 8761 * 8762 * Internal ice_open implementation. Should not be used directly except for ice_open and reset 8763 * handling routine 8764 * 8765 * Returns 0 on success, negative value on failure 8766 */ 8767 int ice_open_internal(struct net_device *netdev) 8768 { 8769 struct ice_netdev_priv *np = netdev_priv(netdev); 8770 struct ice_vsi *vsi = np->vsi; 8771 struct ice_pf *pf = vsi->back; 8772 struct ice_port_info *pi; 8773 int err; 8774 8775 if (test_bit(ICE_NEEDS_RESTART, pf->state)) { 8776 netdev_err(netdev, "driver needs to be unloaded and reloaded\n"); 8777 return -EIO; 8778 } 8779 8780 netif_carrier_off(netdev); 8781 8782 pi = vsi->port_info; 8783 err = ice_update_link_info(pi); 8784 if (err) { 8785 netdev_err(netdev, "Failed to get link info, error %d\n", err); 8786 return err; 8787 } 8788 8789 ice_check_link_cfg_err(pf, pi->phy.link_info.link_cfg_err); 8790 8791 /* Set PHY if there is media, otherwise, turn off PHY */ 8792 if (pi->phy.link_info.link_info & ICE_AQ_MEDIA_AVAILABLE) { 8793 clear_bit(ICE_FLAG_NO_MEDIA, pf->flags); 8794 if (!test_bit(ICE_PHY_INIT_COMPLETE, pf->state)) { 8795 err = ice_init_phy_user_cfg(pi); 8796 if (err) { 8797 netdev_err(netdev, "Failed to initialize PHY settings, error %d\n", 8798 err); 8799 return err; 8800 } 8801 } 8802 8803 err = ice_configure_phy(vsi); 8804 if (err) { 8805 netdev_err(netdev, "Failed to set physical link up, error %d\n", 8806 err); 8807 return err; 8808 } 8809 } else { 8810 set_bit(ICE_FLAG_NO_MEDIA, pf->flags); 8811 ice_set_link(vsi, false); 8812 } 8813 8814 err = ice_vsi_open(vsi); 8815 if (err) 8816 netdev_err(netdev, "Failed to open VSI 0x%04X on switch 0x%04X\n", 8817 vsi->vsi_num, vsi->vsw->sw_id); 8818 8819 /* Update existing tunnels information */ 8820 udp_tunnel_get_rx_info(netdev); 8821 8822 return err; 8823 } 8824 8825 /** 8826 * ice_stop - Disables a network interface 8827 * @netdev: network interface device structure 8828 * 8829 * The stop entry point is called when an interface is de-activated by the OS, 8830 * and the netdevice enters the DOWN state. The hardware is still under the 8831 * driver's control, but the netdev interface is disabled. 8832 * 8833 * Returns success only - not allowed to fail 8834 */ 8835 int ice_stop(struct net_device *netdev) 8836 { 8837 struct ice_netdev_priv *np = netdev_priv(netdev); 8838 struct ice_vsi *vsi = np->vsi; 8839 struct ice_pf *pf = vsi->back; 8840 8841 if (ice_is_reset_in_progress(pf->state)) { 8842 netdev_err(netdev, "can't stop net device while reset is in progress"); 8843 return -EBUSY; 8844 } 8845 8846 ice_vsi_close(vsi); 8847 8848 return 0; 8849 } 8850 8851 /** 8852 * ice_features_check - Validate encapsulated packet conforms to limits 8853 * @skb: skb buffer 8854 * @netdev: This port's netdev 8855 * @features: Offload features that the stack believes apply 8856 */ 8857 static netdev_features_t 8858 ice_features_check(struct sk_buff *skb, 8859 struct net_device __always_unused *netdev, 8860 netdev_features_t features) 8861 { 8862 bool gso = skb_is_gso(skb); 8863 size_t len; 8864 8865 /* No point in doing any of this if neither checksum nor GSO are 8866 * being requested for this frame. We can rule out both by just 8867 * checking for CHECKSUM_PARTIAL 8868 */ 8869 if (skb->ip_summed != CHECKSUM_PARTIAL) 8870 return features; 8871 8872 /* We cannot support GSO if the MSS is going to be less than 8873 * 64 bytes. If it is then we need to drop support for GSO. 8874 */ 8875 if (gso && (skb_shinfo(skb)->gso_size < ICE_TXD_CTX_MIN_MSS)) 8876 features &= ~NETIF_F_GSO_MASK; 8877 8878 len = skb_network_offset(skb); 8879 if (len > ICE_TXD_MACLEN_MAX || len & 0x1) 8880 goto out_rm_features; 8881 8882 len = skb_network_header_len(skb); 8883 if (len > ICE_TXD_IPLEN_MAX || len & 0x1) 8884 goto out_rm_features; 8885 8886 if (skb->encapsulation) { 8887 /* this must work for VXLAN frames AND IPIP/SIT frames, and in 8888 * the case of IPIP frames, the transport header pointer is 8889 * after the inner header! So check to make sure that this 8890 * is a GRE or UDP_TUNNEL frame before doing that math. 8891 */ 8892 if (gso && (skb_shinfo(skb)->gso_type & 8893 (SKB_GSO_GRE | SKB_GSO_UDP_TUNNEL))) { 8894 len = skb_inner_network_header(skb) - 8895 skb_transport_header(skb); 8896 if (len > ICE_TXD_L4LEN_MAX || len & 0x1) 8897 goto out_rm_features; 8898 } 8899 8900 len = skb_inner_network_header_len(skb); 8901 if (len > ICE_TXD_IPLEN_MAX || len & 0x1) 8902 goto out_rm_features; 8903 } 8904 8905 return features; 8906 out_rm_features: 8907 return features & ~(NETIF_F_CSUM_MASK | NETIF_F_GSO_MASK); 8908 } 8909 8910 static const struct net_device_ops ice_netdev_safe_mode_ops = { 8911 .ndo_open = ice_open, 8912 .ndo_stop = ice_stop, 8913 .ndo_start_xmit = ice_start_xmit, 8914 .ndo_set_mac_address = ice_set_mac_address, 8915 .ndo_validate_addr = eth_validate_addr, 8916 .ndo_change_mtu = ice_change_mtu, 8917 .ndo_get_stats64 = ice_get_stats64, 8918 .ndo_tx_timeout = ice_tx_timeout, 8919 .ndo_bpf = ice_xdp_safe_mode, 8920 }; 8921 8922 static const struct net_device_ops ice_netdev_ops = { 8923 .ndo_open = ice_open, 8924 .ndo_stop = ice_stop, 8925 .ndo_start_xmit = ice_start_xmit, 8926 .ndo_select_queue = ice_select_queue, 8927 .ndo_features_check = ice_features_check, 8928 .ndo_fix_features = ice_fix_features, 8929 .ndo_set_rx_mode = ice_set_rx_mode, 8930 .ndo_set_mac_address = ice_set_mac_address, 8931 .ndo_validate_addr = eth_validate_addr, 8932 .ndo_change_mtu = ice_change_mtu, 8933 .ndo_get_stats64 = ice_get_stats64, 8934 .ndo_set_tx_maxrate = ice_set_tx_maxrate, 8935 .ndo_eth_ioctl = ice_eth_ioctl, 8936 .ndo_set_vf_spoofchk = ice_set_vf_spoofchk, 8937 .ndo_set_vf_mac = ice_set_vf_mac, 8938 .ndo_get_vf_config = ice_get_vf_cfg, 8939 .ndo_set_vf_trust = ice_set_vf_trust, 8940 .ndo_set_vf_vlan = ice_set_vf_port_vlan, 8941 .ndo_set_vf_link_state = ice_set_vf_link_state, 8942 .ndo_get_vf_stats = ice_get_vf_stats, 8943 .ndo_set_vf_rate = ice_set_vf_bw, 8944 .ndo_vlan_rx_add_vid = ice_vlan_rx_add_vid, 8945 .ndo_vlan_rx_kill_vid = ice_vlan_rx_kill_vid, 8946 .ndo_setup_tc = ice_setup_tc, 8947 .ndo_set_features = ice_set_features, 8948 .ndo_bridge_getlink = ice_bridge_getlink, 8949 .ndo_bridge_setlink = ice_bridge_setlink, 8950 .ndo_fdb_add = ice_fdb_add, 8951 .ndo_fdb_del = ice_fdb_del, 8952 #ifdef CONFIG_RFS_ACCEL 8953 .ndo_rx_flow_steer = ice_rx_flow_steer, 8954 #endif 8955 .ndo_tx_timeout = ice_tx_timeout, 8956 .ndo_bpf = ice_xdp, 8957 .ndo_xdp_xmit = ice_xdp_xmit, 8958 .ndo_xsk_wakeup = ice_xsk_wakeup, 8959 .ndo_get_devlink_port = ice_get_devlink_port, 8960 }; 8961