137b6f646SAnirudh Venkataramanan // SPDX-License-Identifier: GPL-2.0 237b6f646SAnirudh Venkataramanan /* Copyright (c) 2019, Intel Corporation. */ 337b6f646SAnirudh Venkataramanan 437b6f646SAnirudh Venkataramanan #include "ice_dcb_lib.h" 5b94b013eSDave Ertman #include "ice_dcb_nl.h" 637b6f646SAnirudh Venkataramanan 737b6f646SAnirudh Venkataramanan /** 8462acf6aSTony Nguyen * ice_vsi_cfg_netdev_tc - Setup the netdev TC configuration 9462acf6aSTony Nguyen * @vsi: the VSI being configured 10462acf6aSTony Nguyen * @ena_tc: TC map to be enabled 11462acf6aSTony Nguyen */ 12462acf6aSTony Nguyen void ice_vsi_cfg_netdev_tc(struct ice_vsi *vsi, u8 ena_tc) 13462acf6aSTony Nguyen { 14462acf6aSTony Nguyen struct net_device *netdev = vsi->netdev; 15462acf6aSTony Nguyen struct ice_pf *pf = vsi->back; 16462acf6aSTony Nguyen struct ice_dcbx_cfg *dcbcfg; 17462acf6aSTony Nguyen u8 netdev_tc; 18462acf6aSTony Nguyen int i; 19462acf6aSTony Nguyen 20462acf6aSTony Nguyen if (!netdev) 21462acf6aSTony Nguyen return; 22462acf6aSTony Nguyen 23462acf6aSTony Nguyen if (!ena_tc) { 24462acf6aSTony Nguyen netdev_reset_tc(netdev); 25462acf6aSTony Nguyen return; 26462acf6aSTony Nguyen } 27462acf6aSTony Nguyen 28462acf6aSTony Nguyen if (netdev_set_num_tc(netdev, vsi->tc_cfg.numtc)) 29462acf6aSTony Nguyen return; 30462acf6aSTony Nguyen 31462acf6aSTony Nguyen dcbcfg = &pf->hw.port_info->local_dcbx_cfg; 32462acf6aSTony Nguyen 33462acf6aSTony Nguyen ice_for_each_traffic_class(i) 34462acf6aSTony Nguyen if (vsi->tc_cfg.ena_tc & BIT(i)) 35462acf6aSTony Nguyen netdev_set_tc_queue(netdev, 36462acf6aSTony Nguyen vsi->tc_cfg.tc_info[i].netdev_tc, 37462acf6aSTony Nguyen vsi->tc_cfg.tc_info[i].qcount_tx, 38462acf6aSTony Nguyen vsi->tc_cfg.tc_info[i].qoffset); 39462acf6aSTony Nguyen 40462acf6aSTony Nguyen for (i = 0; i < ICE_MAX_USER_PRIORITY; i++) { 41462acf6aSTony Nguyen u8 ets_tc = dcbcfg->etscfg.prio_table[i]; 42462acf6aSTony Nguyen 43462acf6aSTony Nguyen /* Get the mapped netdev TC# for the UP */ 44462acf6aSTony Nguyen netdev_tc = vsi->tc_cfg.tc_info[ets_tc].netdev_tc; 45462acf6aSTony Nguyen netdev_set_prio_tc_map(netdev, i, netdev_tc); 46462acf6aSTony Nguyen } 47462acf6aSTony Nguyen } 48462acf6aSTony Nguyen 49462acf6aSTony Nguyen /** 507b9ffc76SAnirudh Venkataramanan * ice_dcb_get_ena_tc - return bitmap of enabled TCs 517b9ffc76SAnirudh Venkataramanan * @dcbcfg: DCB config to evaluate for enabled TCs 527b9ffc76SAnirudh Venkataramanan */ 537b9ffc76SAnirudh Venkataramanan u8 ice_dcb_get_ena_tc(struct ice_dcbx_cfg *dcbcfg) 547b9ffc76SAnirudh Venkataramanan { 557b9ffc76SAnirudh Venkataramanan u8 i, num_tc, ena_tc = 1; 567b9ffc76SAnirudh Venkataramanan 577b9ffc76SAnirudh Venkataramanan num_tc = ice_dcb_get_num_tc(dcbcfg); 587b9ffc76SAnirudh Venkataramanan 597b9ffc76SAnirudh Venkataramanan for (i = 0; i < num_tc; i++) 607b9ffc76SAnirudh Venkataramanan ena_tc |= BIT(i); 617b9ffc76SAnirudh Venkataramanan 627b9ffc76SAnirudh Venkataramanan return ena_tc; 637b9ffc76SAnirudh Venkataramanan } 647b9ffc76SAnirudh Venkataramanan 657b9ffc76SAnirudh Venkataramanan /** 66610ed0e9SAvinash JD * ice_is_pfc_causing_hung_q 67610ed0e9SAvinash JD * @pf: pointer to PF structure 68610ed0e9SAvinash JD * @txqueue: Tx queue which is supposedly hung queue 69610ed0e9SAvinash JD * 70610ed0e9SAvinash JD * find if PFC is causing the hung queue, if yes return true else false 71610ed0e9SAvinash JD */ 72610ed0e9SAvinash JD bool ice_is_pfc_causing_hung_q(struct ice_pf *pf, unsigned int txqueue) 73610ed0e9SAvinash JD { 74610ed0e9SAvinash JD u8 num_tcs = 0, i, tc, up_mapped_tc, up_in_tc = 0; 75610ed0e9SAvinash JD u64 ref_prio_xoff[ICE_MAX_UP]; 76610ed0e9SAvinash JD struct ice_vsi *vsi; 77610ed0e9SAvinash JD u32 up2tc; 78610ed0e9SAvinash JD 79610ed0e9SAvinash JD vsi = ice_get_main_vsi(pf); 80610ed0e9SAvinash JD if (!vsi) 81610ed0e9SAvinash JD return false; 82610ed0e9SAvinash JD 83610ed0e9SAvinash JD ice_for_each_traffic_class(i) 84610ed0e9SAvinash JD if (vsi->tc_cfg.ena_tc & BIT(i)) 85610ed0e9SAvinash JD num_tcs++; 86610ed0e9SAvinash JD 87610ed0e9SAvinash JD /* first find out the TC to which the hung queue belongs to */ 88610ed0e9SAvinash JD for (tc = 0; tc < num_tcs - 1; tc++) 89610ed0e9SAvinash JD if (ice_find_q_in_range(vsi->tc_cfg.tc_info[tc].qoffset, 90610ed0e9SAvinash JD vsi->tc_cfg.tc_info[tc + 1].qoffset, 91610ed0e9SAvinash JD txqueue)) 92610ed0e9SAvinash JD break; 93610ed0e9SAvinash JD 94610ed0e9SAvinash JD /* Build a bit map of all UPs associated to the suspect hung queue TC, 95610ed0e9SAvinash JD * so that we check for its counter increment. 96610ed0e9SAvinash JD */ 97610ed0e9SAvinash JD up2tc = rd32(&pf->hw, PRTDCB_TUP2TC); 98610ed0e9SAvinash JD for (i = 0; i < ICE_MAX_UP; i++) { 99610ed0e9SAvinash JD up_mapped_tc = (up2tc >> (i * 3)) & 0x7; 100610ed0e9SAvinash JD if (up_mapped_tc == tc) 101610ed0e9SAvinash JD up_in_tc |= BIT(i); 102610ed0e9SAvinash JD } 103610ed0e9SAvinash JD 104610ed0e9SAvinash JD /* Now that we figured out that hung queue is PFC enabled, still the 105610ed0e9SAvinash JD * Tx timeout can be legitimate. So to make sure Tx timeout is 106610ed0e9SAvinash JD * absolutely caused by PFC storm, check if the counters are 107610ed0e9SAvinash JD * incrementing. 108610ed0e9SAvinash JD */ 109610ed0e9SAvinash JD for (i = 0; i < ICE_MAX_UP; i++) 110610ed0e9SAvinash JD if (up_in_tc & BIT(i)) 111610ed0e9SAvinash JD ref_prio_xoff[i] = pf->stats.priority_xoff_rx[i]; 112610ed0e9SAvinash JD 113610ed0e9SAvinash JD ice_update_dcb_stats(pf); 114610ed0e9SAvinash JD 115610ed0e9SAvinash JD for (i = 0; i < ICE_MAX_UP; i++) 116610ed0e9SAvinash JD if (up_in_tc & BIT(i)) 117610ed0e9SAvinash JD if (pf->stats.priority_xoff_rx[i] > ref_prio_xoff[i]) 118610ed0e9SAvinash JD return true; 119610ed0e9SAvinash JD 120610ed0e9SAvinash JD return false; 121610ed0e9SAvinash JD } 122610ed0e9SAvinash JD 123610ed0e9SAvinash JD /** 12427d9be98SAvinash Dayanand * ice_dcb_get_mode - gets the DCB mode 12527d9be98SAvinash Dayanand * @port_info: pointer to port info structure 12627d9be98SAvinash Dayanand * @host: if set it's HOST if not it's MANAGED 12727d9be98SAvinash Dayanand */ 12827d9be98SAvinash Dayanand static u8 ice_dcb_get_mode(struct ice_port_info *port_info, bool host) 12927d9be98SAvinash Dayanand { 13027d9be98SAvinash Dayanand u8 mode; 13127d9be98SAvinash Dayanand 13227d9be98SAvinash Dayanand if (host) 13327d9be98SAvinash Dayanand mode = DCB_CAP_DCBX_HOST; 13427d9be98SAvinash Dayanand else 13527d9be98SAvinash Dayanand mode = DCB_CAP_DCBX_LLD_MANAGED; 13627d9be98SAvinash Dayanand 13727d9be98SAvinash Dayanand if (port_info->local_dcbx_cfg.dcbx_mode & ICE_DCBX_MODE_CEE) 138f3beaf24SJeff Kirsher return mode | DCB_CAP_DCBX_VER_CEE; 13927d9be98SAvinash Dayanand else 140f3beaf24SJeff Kirsher return mode | DCB_CAP_DCBX_VER_IEEE; 14127d9be98SAvinash Dayanand } 14227d9be98SAvinash Dayanand 14327d9be98SAvinash Dayanand /** 1447b9ffc76SAnirudh Venkataramanan * ice_dcb_get_num_tc - Get the number of TCs from DCBX config 1457b9ffc76SAnirudh Venkataramanan * @dcbcfg: config to retrieve number of TCs from 1467b9ffc76SAnirudh Venkataramanan */ 1477b9ffc76SAnirudh Venkataramanan u8 ice_dcb_get_num_tc(struct ice_dcbx_cfg *dcbcfg) 1487b9ffc76SAnirudh Venkataramanan { 1497b9ffc76SAnirudh Venkataramanan bool tc_unused = false; 1507b9ffc76SAnirudh Venkataramanan u8 num_tc = 0; 1517b9ffc76SAnirudh Venkataramanan u8 ret = 0; 1527b9ffc76SAnirudh Venkataramanan int i; 1537b9ffc76SAnirudh Venkataramanan 1547b9ffc76SAnirudh Venkataramanan /* Scan the ETS Config Priority Table to find traffic classes 1557b9ffc76SAnirudh Venkataramanan * enabled and create a bitmask of enabled TCs 1567b9ffc76SAnirudh Venkataramanan */ 1577b9ffc76SAnirudh Venkataramanan for (i = 0; i < CEE_DCBX_MAX_PRIO; i++) 1587b9ffc76SAnirudh Venkataramanan num_tc |= BIT(dcbcfg->etscfg.prio_table[i]); 1597b9ffc76SAnirudh Venkataramanan 1607b9ffc76SAnirudh Venkataramanan /* Scan bitmask for contiguous TCs starting with TC0 */ 1617b9ffc76SAnirudh Venkataramanan for (i = 0; i < IEEE_8021QAZ_MAX_TCS; i++) { 1627b9ffc76SAnirudh Venkataramanan if (num_tc & BIT(i)) { 1637b9ffc76SAnirudh Venkataramanan if (!tc_unused) { 1647b9ffc76SAnirudh Venkataramanan ret++; 1657b9ffc76SAnirudh Venkataramanan } else { 1667b9ffc76SAnirudh Venkataramanan pr_err("Non-contiguous TCs - Disabling DCB\n"); 1677b9ffc76SAnirudh Venkataramanan return 1; 1687b9ffc76SAnirudh Venkataramanan } 1697b9ffc76SAnirudh Venkataramanan } else { 1707b9ffc76SAnirudh Venkataramanan tc_unused = true; 1717b9ffc76SAnirudh Venkataramanan } 1727b9ffc76SAnirudh Venkataramanan } 1737b9ffc76SAnirudh Venkataramanan 1747b9ffc76SAnirudh Venkataramanan /* There is always at least 1 TC */ 1757b9ffc76SAnirudh Venkataramanan if (!ret) 1767b9ffc76SAnirudh Venkataramanan ret = 1; 1777b9ffc76SAnirudh Venkataramanan 1787b9ffc76SAnirudh Venkataramanan return ret; 1797b9ffc76SAnirudh Venkataramanan } 1807b9ffc76SAnirudh Venkataramanan 1817b9ffc76SAnirudh Venkataramanan /** 1821ddef455SUsha Ketineni * ice_dcb_get_tc - Get the TC associated with the queue 1831ddef455SUsha Ketineni * @vsi: ptr to the VSI 1841ddef455SUsha Ketineni * @queue_index: queue number associated with VSI 1851ddef455SUsha Ketineni */ 1861ddef455SUsha Ketineni u8 ice_dcb_get_tc(struct ice_vsi *vsi, int queue_index) 1871ddef455SUsha Ketineni { 1881ddef455SUsha Ketineni return vsi->tx_rings[queue_index]->dcb_tc; 1891ddef455SUsha Ketineni } 1901ddef455SUsha Ketineni 1911ddef455SUsha Ketineni /** 192a629cf0aSAnirudh Venkataramanan * ice_vsi_cfg_dcb_rings - Update rings to reflect DCB TC 193a629cf0aSAnirudh Venkataramanan * @vsi: VSI owner of rings being updated 194a629cf0aSAnirudh Venkataramanan */ 195a629cf0aSAnirudh Venkataramanan void ice_vsi_cfg_dcb_rings(struct ice_vsi *vsi) 196a629cf0aSAnirudh Venkataramanan { 197a629cf0aSAnirudh Venkataramanan struct ice_ring *tx_ring, *rx_ring; 198a629cf0aSAnirudh Venkataramanan u16 qoffset, qcount; 199a629cf0aSAnirudh Venkataramanan int i, n; 200a629cf0aSAnirudh Venkataramanan 201a629cf0aSAnirudh Venkataramanan if (!test_bit(ICE_FLAG_DCB_ENA, vsi->back->flags)) { 202a629cf0aSAnirudh Venkataramanan /* Reset the TC information */ 203a629cf0aSAnirudh Venkataramanan for (i = 0; i < vsi->num_txq; i++) { 204a629cf0aSAnirudh Venkataramanan tx_ring = vsi->tx_rings[i]; 205a629cf0aSAnirudh Venkataramanan tx_ring->dcb_tc = 0; 206a629cf0aSAnirudh Venkataramanan } 207a629cf0aSAnirudh Venkataramanan for (i = 0; i < vsi->num_rxq; i++) { 208a629cf0aSAnirudh Venkataramanan rx_ring = vsi->rx_rings[i]; 209a629cf0aSAnirudh Venkataramanan rx_ring->dcb_tc = 0; 210a629cf0aSAnirudh Venkataramanan } 211a629cf0aSAnirudh Venkataramanan return; 212a629cf0aSAnirudh Venkataramanan } 213a629cf0aSAnirudh Venkataramanan 214a629cf0aSAnirudh Venkataramanan ice_for_each_traffic_class(n) { 215a629cf0aSAnirudh Venkataramanan if (!(vsi->tc_cfg.ena_tc & BIT(n))) 216a629cf0aSAnirudh Venkataramanan break; 217a629cf0aSAnirudh Venkataramanan 218a629cf0aSAnirudh Venkataramanan qoffset = vsi->tc_cfg.tc_info[n].qoffset; 219a629cf0aSAnirudh Venkataramanan qcount = vsi->tc_cfg.tc_info[n].qcount_tx; 220a629cf0aSAnirudh Venkataramanan for (i = qoffset; i < (qoffset + qcount); i++) { 221a629cf0aSAnirudh Venkataramanan tx_ring = vsi->tx_rings[i]; 222a629cf0aSAnirudh Venkataramanan rx_ring = vsi->rx_rings[i]; 223a629cf0aSAnirudh Venkataramanan tx_ring->dcb_tc = n; 224a629cf0aSAnirudh Venkataramanan rx_ring->dcb_tc = n; 225a629cf0aSAnirudh Venkataramanan } 226a629cf0aSAnirudh Venkataramanan } 227a629cf0aSAnirudh Venkataramanan } 228a629cf0aSAnirudh Venkataramanan 229a629cf0aSAnirudh Venkataramanan /** 230a29a912dSAvinash Dayanand * ice_dcb_bwchk - check if ETS bandwidth input parameters are correct 231a29a912dSAvinash Dayanand * @pf: pointer to the PF struct 232a29a912dSAvinash Dayanand * @dcbcfg: pointer to DCB config structure 233a29a912dSAvinash Dayanand */ 234a29a912dSAvinash Dayanand int ice_dcb_bwchk(struct ice_pf *pf, struct ice_dcbx_cfg *dcbcfg) 235a29a912dSAvinash Dayanand { 236a29a912dSAvinash Dayanand struct ice_dcb_ets_cfg *etscfg = &dcbcfg->etscfg; 237a29a912dSAvinash Dayanand u8 num_tc, total_bw = 0; 238a29a912dSAvinash Dayanand int i; 239a29a912dSAvinash Dayanand 240a29a912dSAvinash Dayanand /* returns number of contigous TCs and 1 TC for non-contigous TCs, 241a29a912dSAvinash Dayanand * since at least 1 TC has to be configured 242a29a912dSAvinash Dayanand */ 243a29a912dSAvinash Dayanand num_tc = ice_dcb_get_num_tc(dcbcfg); 244a29a912dSAvinash Dayanand 245a29a912dSAvinash Dayanand /* no bandwidth checks required if there's only one TC, so assign 246a29a912dSAvinash Dayanand * all bandwidth to TC0 and return 247a29a912dSAvinash Dayanand */ 248a29a912dSAvinash Dayanand if (num_tc == 1) { 249a29a912dSAvinash Dayanand etscfg->tcbwtable[0] = ICE_TC_MAX_BW; 250a29a912dSAvinash Dayanand return 0; 251a29a912dSAvinash Dayanand } 252a29a912dSAvinash Dayanand 253a29a912dSAvinash Dayanand for (i = 0; i < num_tc; i++) 254a29a912dSAvinash Dayanand total_bw += etscfg->tcbwtable[i]; 255a29a912dSAvinash Dayanand 256a29a912dSAvinash Dayanand if (!total_bw) { 257a29a912dSAvinash Dayanand etscfg->tcbwtable[0] = ICE_TC_MAX_BW; 258a29a912dSAvinash Dayanand } else if (total_bw != ICE_TC_MAX_BW) { 259a29a912dSAvinash Dayanand dev_err(ice_pf_to_dev(pf), "Invalid config, total bandwidth must equal 100\n"); 260a29a912dSAvinash Dayanand return -EINVAL; 261a29a912dSAvinash Dayanand } 262a29a912dSAvinash Dayanand 263a29a912dSAvinash Dayanand return 0; 264a29a912dSAvinash Dayanand } 265a29a912dSAvinash Dayanand 266a29a912dSAvinash Dayanand /** 2677b9ffc76SAnirudh Venkataramanan * ice_pf_dcb_cfg - Apply new DCB configuration 2687b9ffc76SAnirudh Venkataramanan * @pf: pointer to the PF struct 2697b9ffc76SAnirudh Venkataramanan * @new_cfg: DCBX config to apply 270e223eaecSDave Ertman * @locked: is the RTNL held 2717b9ffc76SAnirudh Venkataramanan */ 272e223eaecSDave Ertman int ice_pf_dcb_cfg(struct ice_pf *pf, struct ice_dcbx_cfg *new_cfg, bool locked) 2737b9ffc76SAnirudh Venkataramanan { 2747b9ffc76SAnirudh Venkataramanan struct ice_aqc_port_ets_elem buf = { 0 }; 275b94b013eSDave Ertman struct ice_dcbx_cfg *old_cfg, *curr_cfg; 2764015d11eSBrett Creeley struct device *dev = ice_pf_to_dev(pf); 277b94b013eSDave Ertman int ret = ICE_DCB_NO_HW_CHG; 2789d614b64SAnirudh Venkataramanan struct ice_vsi *pf_vsi; 2797b9ffc76SAnirudh Venkataramanan 2807b9ffc76SAnirudh Venkataramanan curr_cfg = &pf->hw.port_info->local_dcbx_cfg; 2817b9ffc76SAnirudh Venkataramanan 282b94b013eSDave Ertman /* FW does not care if change happened */ 283b94b013eSDave Ertman if (!pf->hw.port_info->is_sw_lldp) 284b94b013eSDave Ertman ret = ICE_DCB_HW_CHG_RST; 285b94b013eSDave Ertman 2867b9ffc76SAnirudh Venkataramanan /* Enable DCB tagging only when more than one TC */ 2877b9ffc76SAnirudh Venkataramanan if (ice_dcb_get_num_tc(new_cfg) > 1) { 2884015d11eSBrett Creeley dev_dbg(dev, "DCB tagging enabled (num TC > 1)\n"); 2897b9ffc76SAnirudh Venkataramanan set_bit(ICE_FLAG_DCB_ENA, pf->flags); 2907b9ffc76SAnirudh Venkataramanan } else { 2914015d11eSBrett Creeley dev_dbg(dev, "DCB tagging disabled (num TC = 1)\n"); 2927b9ffc76SAnirudh Venkataramanan clear_bit(ICE_FLAG_DCB_ENA, pf->flags); 2937b9ffc76SAnirudh Venkataramanan } 2947b9ffc76SAnirudh Venkataramanan 2957b9ffc76SAnirudh Venkataramanan if (!memcmp(new_cfg, curr_cfg, sizeof(*new_cfg))) { 2964015d11eSBrett Creeley dev_dbg(dev, "No change in DCB config required\n"); 2977b9ffc76SAnirudh Venkataramanan return ret; 2987b9ffc76SAnirudh Venkataramanan } 2997b9ffc76SAnirudh Venkataramanan 300a29a912dSAvinash Dayanand if (ice_dcb_bwchk(pf, new_cfg)) 301a29a912dSAvinash Dayanand return -EINVAL; 302a29a912dSAvinash Dayanand 3037b9ffc76SAnirudh Venkataramanan /* Store old config in case FW config fails */ 3049d614b64SAnirudh Venkataramanan old_cfg = kmemdup(curr_cfg, sizeof(*old_cfg), GFP_KERNEL); 3059d614b64SAnirudh Venkataramanan if (!old_cfg) 3069d614b64SAnirudh Venkataramanan return -ENOMEM; 3079d614b64SAnirudh Venkataramanan 3084015d11eSBrett Creeley dev_info(dev, "Commit DCB Configuration to the hardware\n"); 3099d614b64SAnirudh Venkataramanan pf_vsi = ice_get_main_vsi(pf); 3109d614b64SAnirudh Venkataramanan if (!pf_vsi) { 3114015d11eSBrett Creeley dev_dbg(dev, "PF VSI doesn't exist\n"); 3129d614b64SAnirudh Venkataramanan ret = -EINVAL; 3139d614b64SAnirudh Venkataramanan goto free_cfg; 3149d614b64SAnirudh Venkataramanan } 3157b9ffc76SAnirudh Venkataramanan 3167b9ffc76SAnirudh Venkataramanan /* avoid race conditions by holding the lock while disabling and 3177b9ffc76SAnirudh Venkataramanan * re-enabling the VSI 3187b9ffc76SAnirudh Venkataramanan */ 319e223eaecSDave Ertman if (!locked) 3207b9ffc76SAnirudh Venkataramanan rtnl_lock(); 3219d614b64SAnirudh Venkataramanan ice_dis_vsi(pf_vsi, true); 3227b9ffc76SAnirudh Venkataramanan 3237b9ffc76SAnirudh Venkataramanan memcpy(curr_cfg, new_cfg, sizeof(*curr_cfg)); 3247b9ffc76SAnirudh Venkataramanan memcpy(&curr_cfg->etsrec, &curr_cfg->etscfg, sizeof(curr_cfg->etsrec)); 325b94b013eSDave Ertman memcpy(&new_cfg->etsrec, &curr_cfg->etscfg, sizeof(curr_cfg->etsrec)); 3267b9ffc76SAnirudh Venkataramanan 3277b9ffc76SAnirudh Venkataramanan /* Only send new config to HW if we are in SW LLDP mode. Otherwise, 3287b9ffc76SAnirudh Venkataramanan * the new config came from the HW in the first place. 3297b9ffc76SAnirudh Venkataramanan */ 3307b9ffc76SAnirudh Venkataramanan if (pf->hw.port_info->is_sw_lldp) { 3317b9ffc76SAnirudh Venkataramanan ret = ice_set_dcb_cfg(pf->hw.port_info); 3327b9ffc76SAnirudh Venkataramanan if (ret) { 3334015d11eSBrett Creeley dev_err(dev, "Set DCB Config failed\n"); 3347b9ffc76SAnirudh Venkataramanan /* Restore previous settings to local config */ 3357b9ffc76SAnirudh Venkataramanan memcpy(curr_cfg, old_cfg, sizeof(*curr_cfg)); 3367b9ffc76SAnirudh Venkataramanan goto out; 3377b9ffc76SAnirudh Venkataramanan } 3387b9ffc76SAnirudh Venkataramanan } 3397b9ffc76SAnirudh Venkataramanan 3407b9ffc76SAnirudh Venkataramanan ret = ice_query_port_ets(pf->hw.port_info, &buf, sizeof(buf), NULL); 3417b9ffc76SAnirudh Venkataramanan if (ret) { 3424015d11eSBrett Creeley dev_err(dev, "Query Port ETS failed\n"); 3437b9ffc76SAnirudh Venkataramanan goto out; 3447b9ffc76SAnirudh Venkataramanan } 3457b9ffc76SAnirudh Venkataramanan 3467b9ffc76SAnirudh Venkataramanan ice_pf_dcb_recfg(pf); 3477b9ffc76SAnirudh Venkataramanan 3487b9ffc76SAnirudh Venkataramanan out: 3499d614b64SAnirudh Venkataramanan ice_ena_vsi(pf_vsi, true); 350e223eaecSDave Ertman if (!locked) 3517b9ffc76SAnirudh Venkataramanan rtnl_unlock(); 3529d614b64SAnirudh Venkataramanan free_cfg: 3539d614b64SAnirudh Venkataramanan kfree(old_cfg); 3547b9ffc76SAnirudh Venkataramanan return ret; 3557b9ffc76SAnirudh Venkataramanan } 3567b9ffc76SAnirudh Venkataramanan 3577b9ffc76SAnirudh Venkataramanan /** 3587829570eSUsha Ketineni * ice_cfg_etsrec_defaults - Set default ETS recommended DCB config 3597829570eSUsha Ketineni * @pi: port information structure 3607829570eSUsha Ketineni */ 3617829570eSUsha Ketineni static void ice_cfg_etsrec_defaults(struct ice_port_info *pi) 3627829570eSUsha Ketineni { 3637829570eSUsha Ketineni struct ice_dcbx_cfg *dcbcfg = &pi->local_dcbx_cfg; 3647829570eSUsha Ketineni u8 i; 3657829570eSUsha Ketineni 3667829570eSUsha Ketineni /* Ensure ETS recommended DCB configuration is not already set */ 3677829570eSUsha Ketineni if (dcbcfg->etsrec.maxtcs) 3687829570eSUsha Ketineni return; 3697829570eSUsha Ketineni 3707829570eSUsha Ketineni /* In CEE mode, set the default to 1 TC */ 3717829570eSUsha Ketineni dcbcfg->etsrec.maxtcs = 1; 3727829570eSUsha Ketineni for (i = 0; i < ICE_MAX_TRAFFIC_CLASS; i++) { 3737829570eSUsha Ketineni dcbcfg->etsrec.tcbwtable[i] = i ? 0 : 100; 3747829570eSUsha Ketineni dcbcfg->etsrec.tsatable[i] = i ? ICE_IEEE_TSA_STRICT : 3757829570eSUsha Ketineni ICE_IEEE_TSA_ETS; 3767829570eSUsha Ketineni } 3777829570eSUsha Ketineni } 3787829570eSUsha Ketineni 3797829570eSUsha Ketineni /** 3807829570eSUsha Ketineni * ice_dcb_need_recfg - Check if DCB needs reconfig 3817829570eSUsha Ketineni * @pf: board private structure 3827829570eSUsha Ketineni * @old_cfg: current DCB config 3837829570eSUsha Ketineni * @new_cfg: new DCB config 3847829570eSUsha Ketineni */ 3857829570eSUsha Ketineni static bool 3867829570eSUsha Ketineni ice_dcb_need_recfg(struct ice_pf *pf, struct ice_dcbx_cfg *old_cfg, 3877829570eSUsha Ketineni struct ice_dcbx_cfg *new_cfg) 3887829570eSUsha Ketineni { 3894015d11eSBrett Creeley struct device *dev = ice_pf_to_dev(pf); 3907829570eSUsha Ketineni bool need_reconfig = false; 3917829570eSUsha Ketineni 3927829570eSUsha Ketineni /* Check if ETS configuration has changed */ 3937829570eSUsha Ketineni if (memcmp(&new_cfg->etscfg, &old_cfg->etscfg, 3947829570eSUsha Ketineni sizeof(new_cfg->etscfg))) { 3957829570eSUsha Ketineni /* If Priority Table has changed reconfig is needed */ 3967829570eSUsha Ketineni if (memcmp(&new_cfg->etscfg.prio_table, 3977829570eSUsha Ketineni &old_cfg->etscfg.prio_table, 3987829570eSUsha Ketineni sizeof(new_cfg->etscfg.prio_table))) { 3997829570eSUsha Ketineni need_reconfig = true; 4004015d11eSBrett Creeley dev_dbg(dev, "ETS UP2TC changed.\n"); 4017829570eSUsha Ketineni } 4027829570eSUsha Ketineni 4037829570eSUsha Ketineni if (memcmp(&new_cfg->etscfg.tcbwtable, 4047829570eSUsha Ketineni &old_cfg->etscfg.tcbwtable, 4057829570eSUsha Ketineni sizeof(new_cfg->etscfg.tcbwtable))) 4064015d11eSBrett Creeley dev_dbg(dev, "ETS TC BW Table changed.\n"); 4077829570eSUsha Ketineni 4087829570eSUsha Ketineni if (memcmp(&new_cfg->etscfg.tsatable, 4097829570eSUsha Ketineni &old_cfg->etscfg.tsatable, 4107829570eSUsha Ketineni sizeof(new_cfg->etscfg.tsatable))) 4114015d11eSBrett Creeley dev_dbg(dev, "ETS TSA Table changed.\n"); 4127829570eSUsha Ketineni } 4137829570eSUsha Ketineni 4147829570eSUsha Ketineni /* Check if PFC configuration has changed */ 4157829570eSUsha Ketineni if (memcmp(&new_cfg->pfc, &old_cfg->pfc, sizeof(new_cfg->pfc))) { 4167829570eSUsha Ketineni need_reconfig = true; 4174015d11eSBrett Creeley dev_dbg(dev, "PFC config change detected.\n"); 4187829570eSUsha Ketineni } 4197829570eSUsha Ketineni 4207829570eSUsha Ketineni /* Check if APP Table has changed */ 4217829570eSUsha Ketineni if (memcmp(&new_cfg->app, &old_cfg->app, sizeof(new_cfg->app))) { 4227829570eSUsha Ketineni need_reconfig = true; 4234015d11eSBrett Creeley dev_dbg(dev, "APP Table change detected.\n"); 4247829570eSUsha Ketineni } 4257829570eSUsha Ketineni 4264015d11eSBrett Creeley dev_dbg(dev, "dcb need_reconfig=%d\n", need_reconfig); 4277829570eSUsha Ketineni return need_reconfig; 4287829570eSUsha Ketineni } 4297829570eSUsha Ketineni 4307829570eSUsha Ketineni /** 431b832c2f6SAnirudh Venkataramanan * ice_dcb_rebuild - rebuild DCB post reset 432b832c2f6SAnirudh Venkataramanan * @pf: physical function instance 433b832c2f6SAnirudh Venkataramanan */ 434b832c2f6SAnirudh Venkataramanan void ice_dcb_rebuild(struct ice_pf *pf) 435b832c2f6SAnirudh Venkataramanan { 436b832c2f6SAnirudh Venkataramanan struct ice_aqc_port_ets_elem buf = { 0 }; 4374015d11eSBrett Creeley struct device *dev = ice_pf_to_dev(pf); 438242b5e06SDave Ertman struct ice_dcbx_cfg *err_cfg; 439b832c2f6SAnirudh Venkataramanan enum ice_status ret; 440b832c2f6SAnirudh Venkataramanan 441b832c2f6SAnirudh Venkataramanan ret = ice_query_port_ets(pf->hw.port_info, &buf, sizeof(buf), NULL); 442b832c2f6SAnirudh Venkataramanan if (ret) { 4434015d11eSBrett Creeley dev_err(dev, "Query Port ETS failed\n"); 444b832c2f6SAnirudh Venkataramanan goto dcb_error; 445b832c2f6SAnirudh Venkataramanan } 446b832c2f6SAnirudh Venkataramanan 447b832c2f6SAnirudh Venkataramanan /* If DCB was not enabled previously, we are done */ 448b832c2f6SAnirudh Venkataramanan if (!test_bit(ICE_FLAG_DCB_ENA, pf->flags)) 449b832c2f6SAnirudh Venkataramanan return; 450b832c2f6SAnirudh Venkataramanan 451242b5e06SDave Ertman mutex_lock(&pf->tc_mutex); 4527829570eSUsha Ketineni 453242b5e06SDave Ertman if (!pf->hw.port_info->is_sw_lldp) 4547829570eSUsha Ketineni ice_cfg_etsrec_defaults(pf->hw.port_info); 455242b5e06SDave Ertman 456b832c2f6SAnirudh Venkataramanan ret = ice_set_dcb_cfg(pf->hw.port_info); 457b832c2f6SAnirudh Venkataramanan if (ret) { 458242b5e06SDave Ertman dev_err(dev, "Failed to set DCB config in rebuild\n"); 459b832c2f6SAnirudh Venkataramanan goto dcb_error; 460b832c2f6SAnirudh Venkataramanan } 461b832c2f6SAnirudh Venkataramanan 462242b5e06SDave Ertman if (!pf->hw.port_info->is_sw_lldp) { 463242b5e06SDave Ertman ret = ice_cfg_lldp_mib_change(&pf->hw, true); 464242b5e06SDave Ertman if (ret && !pf->hw.port_info->is_sw_lldp) { 465242b5e06SDave Ertman dev_err(dev, "Failed to register for MIB changes\n"); 466b832c2f6SAnirudh Venkataramanan goto dcb_error; 467b832c2f6SAnirudh Venkataramanan } 468b832c2f6SAnirudh Venkataramanan } 469242b5e06SDave Ertman 4704015d11eSBrett Creeley dev_info(dev, "DCB restored after reset\n"); 471b832c2f6SAnirudh Venkataramanan ret = ice_query_port_ets(pf->hw.port_info, &buf, sizeof(buf), NULL); 472b832c2f6SAnirudh Venkataramanan if (ret) { 4734015d11eSBrett Creeley dev_err(dev, "Query Port ETS failed\n"); 474b832c2f6SAnirudh Venkataramanan goto dcb_error; 475b832c2f6SAnirudh Venkataramanan } 476b832c2f6SAnirudh Venkataramanan 477242b5e06SDave Ertman mutex_unlock(&pf->tc_mutex); 478242b5e06SDave Ertman 479b832c2f6SAnirudh Venkataramanan return; 480b832c2f6SAnirudh Venkataramanan 481b832c2f6SAnirudh Venkataramanan dcb_error: 4824015d11eSBrett Creeley dev_err(dev, "Disabling DCB until new settings occur\n"); 483242b5e06SDave Ertman err_cfg = kzalloc(sizeof(*err_cfg), GFP_KERNEL); 484242b5e06SDave Ertman if (!err_cfg) { 485242b5e06SDave Ertman mutex_unlock(&pf->tc_mutex); 4869efe35d0STony Nguyen return; 487242b5e06SDave Ertman } 4889efe35d0STony Nguyen 489242b5e06SDave Ertman err_cfg->etscfg.willing = true; 490242b5e06SDave Ertman err_cfg->etscfg.tcbwtable[0] = ICE_TC_MAX_BW; 491242b5e06SDave Ertman err_cfg->etscfg.tsatable[0] = ICE_IEEE_TSA_ETS; 492242b5e06SDave Ertman memcpy(&err_cfg->etsrec, &err_cfg->etscfg, sizeof(err_cfg->etsrec)); 493ac614b13SBruce Allan /* Coverity warns the return code of ice_pf_dcb_cfg() is not checked 494ac614b13SBruce Allan * here as is done for other calls to that function. That check is 495ac614b13SBruce Allan * not necessary since this is in this function's error cleanup path. 496ac614b13SBruce Allan * Suppress the Coverity warning with the following comment... 497ac614b13SBruce Allan */ 498ac614b13SBruce Allan /* coverity[check_return] */ 499242b5e06SDave Ertman ice_pf_dcb_cfg(pf, err_cfg, false); 500242b5e06SDave Ertman kfree(err_cfg); 501242b5e06SDave Ertman 502242b5e06SDave Ertman mutex_unlock(&pf->tc_mutex); 503b832c2f6SAnirudh Venkataramanan } 504b832c2f6SAnirudh Venkataramanan 505b832c2f6SAnirudh Venkataramanan /** 5067b9ffc76SAnirudh Venkataramanan * ice_dcb_init_cfg - set the initial DCB config in SW 5072f2da36eSAnirudh Venkataramanan * @pf: PF to apply config to 508e223eaecSDave Ertman * @locked: Is the RTNL held 5097b9ffc76SAnirudh Venkataramanan */ 510e223eaecSDave Ertman static int ice_dcb_init_cfg(struct ice_pf *pf, bool locked) 5117b9ffc76SAnirudh Venkataramanan { 5127b9ffc76SAnirudh Venkataramanan struct ice_dcbx_cfg *newcfg; 5137b9ffc76SAnirudh Venkataramanan struct ice_port_info *pi; 5147b9ffc76SAnirudh Venkataramanan int ret = 0; 5157b9ffc76SAnirudh Venkataramanan 5167b9ffc76SAnirudh Venkataramanan pi = pf->hw.port_info; 5179efe35d0STony Nguyen newcfg = kmemdup(&pi->local_dcbx_cfg, sizeof(*newcfg), GFP_KERNEL); 5187b9ffc76SAnirudh Venkataramanan if (!newcfg) 5197b9ffc76SAnirudh Venkataramanan return -ENOMEM; 5207b9ffc76SAnirudh Venkataramanan 5217b9ffc76SAnirudh Venkataramanan memset(&pi->local_dcbx_cfg, 0, sizeof(*newcfg)); 5227b9ffc76SAnirudh Venkataramanan 5234015d11eSBrett Creeley dev_info(ice_pf_to_dev(pf), "Configuring initial DCB values\n"); 524e223eaecSDave Ertman if (ice_pf_dcb_cfg(pf, newcfg, locked)) 5257b9ffc76SAnirudh Venkataramanan ret = -EINVAL; 5267b9ffc76SAnirudh Venkataramanan 5279efe35d0STony Nguyen kfree(newcfg); 5287b9ffc76SAnirudh Venkataramanan 5297b9ffc76SAnirudh Venkataramanan return ret; 5307b9ffc76SAnirudh Venkataramanan } 5317b9ffc76SAnirudh Venkataramanan 5327b9ffc76SAnirudh Venkataramanan /** 5334ee656bbSTony Nguyen * ice_dcb_sw_dflt_cfg - Apply a default DCB config 5342f2da36eSAnirudh Venkataramanan * @pf: PF to apply config to 5354ee656bbSTony Nguyen * @ets_willing: configure ETS willing 536e223eaecSDave Ertman * @locked: was this function called with RTNL held 5370deab659SAnirudh Venkataramanan */ 538cfbf1367SPaul Greenwalt static int ice_dcb_sw_dflt_cfg(struct ice_pf *pf, bool ets_willing, bool locked) 5390deab659SAnirudh Venkataramanan { 5400deab659SAnirudh Venkataramanan struct ice_aqc_port_ets_elem buf = { 0 }; 5410deab659SAnirudh Venkataramanan struct ice_dcbx_cfg *dcbcfg; 5420deab659SAnirudh Venkataramanan struct ice_port_info *pi; 5430deab659SAnirudh Venkataramanan struct ice_hw *hw; 5440deab659SAnirudh Venkataramanan int ret; 5450deab659SAnirudh Venkataramanan 5460deab659SAnirudh Venkataramanan hw = &pf->hw; 5470deab659SAnirudh Venkataramanan pi = hw->port_info; 5489efe35d0STony Nguyen dcbcfg = kzalloc(sizeof(*dcbcfg), GFP_KERNEL); 5499efe35d0STony Nguyen if (!dcbcfg) 5509efe35d0STony Nguyen return -ENOMEM; 5510deab659SAnirudh Venkataramanan 5520deab659SAnirudh Venkataramanan memset(&pi->local_dcbx_cfg, 0, sizeof(*dcbcfg)); 5530deab659SAnirudh Venkataramanan 554cfbf1367SPaul Greenwalt dcbcfg->etscfg.willing = ets_willing ? 1 : 0; 555a257f188SUsha Ketineni dcbcfg->etscfg.maxtcs = hw->func_caps.common_cap.maxtc; 5560deab659SAnirudh Venkataramanan dcbcfg->etscfg.tcbwtable[0] = 100; 5570deab659SAnirudh Venkataramanan dcbcfg->etscfg.tsatable[0] = ICE_IEEE_TSA_ETS; 5580deab659SAnirudh Venkataramanan 5590deab659SAnirudh Venkataramanan memcpy(&dcbcfg->etsrec, &dcbcfg->etscfg, 5600deab659SAnirudh Venkataramanan sizeof(dcbcfg->etsrec)); 5610deab659SAnirudh Venkataramanan dcbcfg->etsrec.willing = 0; 5620deab659SAnirudh Venkataramanan 5630deab659SAnirudh Venkataramanan dcbcfg->pfc.willing = 1; 564a257f188SUsha Ketineni dcbcfg->pfc.pfccap = hw->func_caps.common_cap.maxtc; 5650deab659SAnirudh Venkataramanan 5660deab659SAnirudh Venkataramanan dcbcfg->numapps = 1; 5670deab659SAnirudh Venkataramanan dcbcfg->app[0].selector = ICE_APP_SEL_ETHTYPE; 5680deab659SAnirudh Venkataramanan dcbcfg->app[0].priority = 3; 5690deab659SAnirudh Venkataramanan dcbcfg->app[0].prot_id = ICE_APP_PROT_ID_FCOE; 5700deab659SAnirudh Venkataramanan 571e223eaecSDave Ertman ret = ice_pf_dcb_cfg(pf, dcbcfg, locked); 5729efe35d0STony Nguyen kfree(dcbcfg); 5730deab659SAnirudh Venkataramanan if (ret) 5740deab659SAnirudh Venkataramanan return ret; 5750deab659SAnirudh Venkataramanan 5760deab659SAnirudh Venkataramanan return ice_query_port_ets(pi, &buf, sizeof(buf), NULL); 5770deab659SAnirudh Venkataramanan } 5780deab659SAnirudh Venkataramanan 5790deab659SAnirudh Venkataramanan /** 580cfbf1367SPaul Greenwalt * ice_dcb_tc_contig - Check that TCs are contiguous 581cfbf1367SPaul Greenwalt * @prio_table: pointer to priority table 582cfbf1367SPaul Greenwalt * 583cfbf1367SPaul Greenwalt * Check if TCs begin with TC0 and are contiguous 584cfbf1367SPaul Greenwalt */ 585cfbf1367SPaul Greenwalt static bool ice_dcb_tc_contig(u8 *prio_table) 586cfbf1367SPaul Greenwalt { 58789154002SDave Ertman bool found_empty = false; 58889154002SDave Ertman u8 used_tc = 0; 589cfbf1367SPaul Greenwalt int i; 590cfbf1367SPaul Greenwalt 59189154002SDave Ertman /* Create a bitmap of used TCs */ 59289154002SDave Ertman for (i = 0; i < CEE_DCBX_MAX_PRIO; i++) 59389154002SDave Ertman used_tc |= BIT(prio_table[i]); 594cfbf1367SPaul Greenwalt 59589154002SDave Ertman for (i = 0; i < CEE_DCBX_MAX_PRIO; i++) { 59689154002SDave Ertman if (used_tc & BIT(i)) { 59789154002SDave Ertman if (found_empty) 598cfbf1367SPaul Greenwalt return false; 59989154002SDave Ertman } else { 60089154002SDave Ertman found_empty = true; 60189154002SDave Ertman } 602cfbf1367SPaul Greenwalt } 603cfbf1367SPaul Greenwalt 604cfbf1367SPaul Greenwalt return true; 605cfbf1367SPaul Greenwalt } 606cfbf1367SPaul Greenwalt 607cfbf1367SPaul Greenwalt /** 608cfbf1367SPaul Greenwalt * ice_dcb_noncontig_cfg - Configure DCB for non-contiguous TCs 609cfbf1367SPaul Greenwalt * @pf: pointer to the PF struct 610cfbf1367SPaul Greenwalt * 611cfbf1367SPaul Greenwalt * If non-contiguous TCs, then configure SW DCB with TC0 and ETS non-willing 612cfbf1367SPaul Greenwalt */ 613cfbf1367SPaul Greenwalt static int ice_dcb_noncontig_cfg(struct ice_pf *pf) 614cfbf1367SPaul Greenwalt { 615cfbf1367SPaul Greenwalt struct ice_dcbx_cfg *dcbcfg = &pf->hw.port_info->local_dcbx_cfg; 6164015d11eSBrett Creeley struct device *dev = ice_pf_to_dev(pf); 617cfbf1367SPaul Greenwalt int ret; 618cfbf1367SPaul Greenwalt 619cfbf1367SPaul Greenwalt /* Configure SW DCB default with ETS non-willing */ 620cfbf1367SPaul Greenwalt ret = ice_dcb_sw_dflt_cfg(pf, false, true); 621cfbf1367SPaul Greenwalt if (ret) { 6224015d11eSBrett Creeley dev_err(dev, "Failed to set local DCB config %d\n", ret); 623cfbf1367SPaul Greenwalt return ret; 624cfbf1367SPaul Greenwalt } 625cfbf1367SPaul Greenwalt 626cfbf1367SPaul Greenwalt /* Reconfigure with ETS willing so that FW will send LLDP MIB event */ 627cfbf1367SPaul Greenwalt dcbcfg->etscfg.willing = 1; 628cfbf1367SPaul Greenwalt ret = ice_set_dcb_cfg(pf->hw.port_info); 629cfbf1367SPaul Greenwalt if (ret) 6304015d11eSBrett Creeley dev_err(dev, "Failed to set DCB to unwilling\n"); 631cfbf1367SPaul Greenwalt 632cfbf1367SPaul Greenwalt return ret; 633cfbf1367SPaul Greenwalt } 634cfbf1367SPaul Greenwalt 635cfbf1367SPaul Greenwalt /** 636cfbf1367SPaul Greenwalt * ice_pf_dcb_recfg - Reconfigure all VEBs and VSIs 637cfbf1367SPaul Greenwalt * @pf: pointer to the PF struct 638cfbf1367SPaul Greenwalt * 639cfbf1367SPaul Greenwalt * Assumed caller has already disabled all VSIs before 640cfbf1367SPaul Greenwalt * calling this function. Reconfiguring DCB based on 641cfbf1367SPaul Greenwalt * local_dcbx_cfg. 642cfbf1367SPaul Greenwalt */ 64387324e74SHenry Tieman void ice_pf_dcb_recfg(struct ice_pf *pf) 644cfbf1367SPaul Greenwalt { 645cfbf1367SPaul Greenwalt struct ice_dcbx_cfg *dcbcfg = &pf->hw.port_info->local_dcbx_cfg; 646cfbf1367SPaul Greenwalt u8 tc_map = 0; 647cfbf1367SPaul Greenwalt int v, ret; 648cfbf1367SPaul Greenwalt 649cfbf1367SPaul Greenwalt /* Update each VSI */ 650cfbf1367SPaul Greenwalt ice_for_each_vsi(pf, v) { 6514015d11eSBrett Creeley struct ice_vsi *vsi = pf->vsi[v]; 6524015d11eSBrett Creeley 6534015d11eSBrett Creeley if (!vsi) 654cfbf1367SPaul Greenwalt continue; 655cfbf1367SPaul Greenwalt 6564015d11eSBrett Creeley if (vsi->type == ICE_VSI_PF) { 657cfbf1367SPaul Greenwalt tc_map = ice_dcb_get_ena_tc(dcbcfg); 658cfbf1367SPaul Greenwalt 659cfbf1367SPaul Greenwalt /* If DCBX request non-contiguous TC, then configure 660cfbf1367SPaul Greenwalt * default TC 661cfbf1367SPaul Greenwalt */ 662cfbf1367SPaul Greenwalt if (!ice_dcb_tc_contig(dcbcfg->etscfg.prio_table)) { 663cfbf1367SPaul Greenwalt tc_map = ICE_DFLT_TRAFFIC_CLASS; 664cfbf1367SPaul Greenwalt ice_dcb_noncontig_cfg(pf); 665cfbf1367SPaul Greenwalt } 666cfbf1367SPaul Greenwalt } else { 667cfbf1367SPaul Greenwalt tc_map = ICE_DFLT_TRAFFIC_CLASS; 668cfbf1367SPaul Greenwalt } 669cfbf1367SPaul Greenwalt 6704015d11eSBrett Creeley ret = ice_vsi_cfg_tc(vsi, tc_map); 671cfbf1367SPaul Greenwalt if (ret) { 6724015d11eSBrett Creeley dev_err(ice_pf_to_dev(pf), "Failed to config TC for VSI index: %d\n", 6734015d11eSBrett Creeley vsi->idx); 674cfbf1367SPaul Greenwalt continue; 675cfbf1367SPaul Greenwalt } 676cfbf1367SPaul Greenwalt 6774015d11eSBrett Creeley ice_vsi_map_rings_to_vectors(vsi); 6784015d11eSBrett Creeley if (vsi->type == ICE_VSI_PF) 6794015d11eSBrett Creeley ice_dcbnl_set_all(vsi); 680cfbf1367SPaul Greenwalt } 681cfbf1367SPaul Greenwalt } 682cfbf1367SPaul Greenwalt 683cfbf1367SPaul Greenwalt /** 68437b6f646SAnirudh Venkataramanan * ice_init_pf_dcb - initialize DCB for a PF 6852f2da36eSAnirudh Venkataramanan * @pf: PF to initialize DCB for 686e223eaecSDave Ertman * @locked: Was function called with RTNL held 68737b6f646SAnirudh Venkataramanan */ 688e223eaecSDave Ertman int ice_init_pf_dcb(struct ice_pf *pf, bool locked) 68937b6f646SAnirudh Venkataramanan { 6904015d11eSBrett Creeley struct device *dev = ice_pf_to_dev(pf); 69137b6f646SAnirudh Venkataramanan struct ice_port_info *port_info; 69237b6f646SAnirudh Venkataramanan struct ice_hw *hw = &pf->hw; 6937b9ffc76SAnirudh Venkataramanan int err; 69437b6f646SAnirudh Venkataramanan 69537b6f646SAnirudh Venkataramanan port_info = hw->port_info; 69637b6f646SAnirudh Venkataramanan 697ea300f41SDave Ertman err = ice_init_dcb(hw, false); 698473ca574SDave Ertman if (err && !port_info->is_sw_lldp) { 6994015d11eSBrett Creeley dev_err(dev, "Error initializing DCB %d\n", err); 700473ca574SDave Ertman goto dcb_init_err; 701473ca574SDave Ertman } 702473ca574SDave Ertman 70319cce2c6SAnirudh Venkataramanan dev_info(dev, "DCB is enabled in the hardware, max number of TCs supported on this port are %d\n", 704a257f188SUsha Ketineni pf->hw.func_caps.common_cap.maxtc); 705473ca574SDave Ertman if (err) { 706241c8cf0SPaul Greenwalt struct ice_vsi *pf_vsi; 707241c8cf0SPaul Greenwalt 708473ca574SDave Ertman /* FW LLDP is disabled, activate SW DCBX/LLDP mode */ 7094015d11eSBrett Creeley dev_info(dev, "FW LLDP is disabled, DCBx/LLDP in SW mode.\n"); 71084a118abSDave Ertman clear_bit(ICE_FLAG_FW_LLDP_AGENT, pf->flags); 711cfbf1367SPaul Greenwalt err = ice_dcb_sw_dflt_cfg(pf, true, locked); 7120deab659SAnirudh Venkataramanan if (err) { 71319cce2c6SAnirudh Venkataramanan dev_err(dev, "Failed to set local DCB config %d\n", 71419cce2c6SAnirudh Venkataramanan err); 7150deab659SAnirudh Venkataramanan err = -EIO; 7167b9ffc76SAnirudh Venkataramanan goto dcb_init_err; 7170deab659SAnirudh Venkataramanan } 7180deab659SAnirudh Venkataramanan 719241c8cf0SPaul Greenwalt /* If the FW DCBX engine is not running then Rx LLDP packets 720241c8cf0SPaul Greenwalt * need to be redirected up the stack. 721241c8cf0SPaul Greenwalt */ 722241c8cf0SPaul Greenwalt pf_vsi = ice_get_main_vsi(pf); 723241c8cf0SPaul Greenwalt if (!pf_vsi) { 7244015d11eSBrett Creeley dev_err(dev, "Failed to set local DCB config\n"); 725241c8cf0SPaul Greenwalt err = -EIO; 726241c8cf0SPaul Greenwalt goto dcb_init_err; 727241c8cf0SPaul Greenwalt } 728241c8cf0SPaul Greenwalt 729241c8cf0SPaul Greenwalt ice_cfg_sw_lldp(pf_vsi, false, true); 730241c8cf0SPaul Greenwalt 73127d9be98SAvinash Dayanand pf->dcbx_cap = ice_dcb_get_mode(port_info, true); 7320deab659SAnirudh Venkataramanan return 0; 7330deab659SAnirudh Venkataramanan } 7347b9ffc76SAnirudh Venkataramanan 73584a118abSDave Ertman set_bit(ICE_FLAG_FW_LLDP_AGENT, pf->flags); 7361b0c3247SDave Ertman 73727d9be98SAvinash Dayanand /* DCBX/LLDP enabled in FW, set DCBNL mode advertisement */ 73827d9be98SAvinash Dayanand pf->dcbx_cap = ice_dcb_get_mode(port_info, false); 7397b9ffc76SAnirudh Venkataramanan 740e223eaecSDave Ertman err = ice_dcb_init_cfg(pf, locked); 7417b9ffc76SAnirudh Venkataramanan if (err) 7427b9ffc76SAnirudh Venkataramanan goto dcb_init_err; 7437b9ffc76SAnirudh Venkataramanan 7447b9ffc76SAnirudh Venkataramanan return err; 7457b9ffc76SAnirudh Venkataramanan 7467b9ffc76SAnirudh Venkataramanan dcb_init_err: 7477b9ffc76SAnirudh Venkataramanan dev_err(dev, "DCB init failed\n"); 7487b9ffc76SAnirudh Venkataramanan return err; 74937b6f646SAnirudh Venkataramanan } 75000cc3f1bSAnirudh Venkataramanan 75100cc3f1bSAnirudh Venkataramanan /** 7524b0fdcebSAnirudh Venkataramanan * ice_update_dcb_stats - Update DCB stats counters 7534b0fdcebSAnirudh Venkataramanan * @pf: PF whose stats needs to be updated 7544b0fdcebSAnirudh Venkataramanan */ 7554b0fdcebSAnirudh Venkataramanan void ice_update_dcb_stats(struct ice_pf *pf) 7564b0fdcebSAnirudh Venkataramanan { 7574b0fdcebSAnirudh Venkataramanan struct ice_hw_port_stats *prev_ps, *cur_ps; 7584b0fdcebSAnirudh Venkataramanan struct ice_hw *hw = &pf->hw; 7599e7a5d17SUsha Ketineni u8 port; 7604b0fdcebSAnirudh Venkataramanan int i; 7614b0fdcebSAnirudh Venkataramanan 7629e7a5d17SUsha Ketineni port = hw->port_info->lport; 7634b0fdcebSAnirudh Venkataramanan prev_ps = &pf->stats_prev; 7644b0fdcebSAnirudh Venkataramanan cur_ps = &pf->stats; 7654b0fdcebSAnirudh Venkataramanan 7664b0fdcebSAnirudh Venkataramanan for (i = 0; i < 8; i++) { 7679e7a5d17SUsha Ketineni ice_stat_update32(hw, GLPRT_PXOFFRXC(port, i), 7684b0fdcebSAnirudh Venkataramanan pf->stat_prev_loaded, 7694b0fdcebSAnirudh Venkataramanan &prev_ps->priority_xoff_rx[i], 7704b0fdcebSAnirudh Venkataramanan &cur_ps->priority_xoff_rx[i]); 7719e7a5d17SUsha Ketineni ice_stat_update32(hw, GLPRT_PXONRXC(port, i), 7724b0fdcebSAnirudh Venkataramanan pf->stat_prev_loaded, 7734b0fdcebSAnirudh Venkataramanan &prev_ps->priority_xon_rx[i], 7744b0fdcebSAnirudh Venkataramanan &cur_ps->priority_xon_rx[i]); 7759e7a5d17SUsha Ketineni ice_stat_update32(hw, GLPRT_PXONTXC(port, i), 7764b0fdcebSAnirudh Venkataramanan pf->stat_prev_loaded, 7774b0fdcebSAnirudh Venkataramanan &prev_ps->priority_xon_tx[i], 7784b0fdcebSAnirudh Venkataramanan &cur_ps->priority_xon_tx[i]); 7799e7a5d17SUsha Ketineni ice_stat_update32(hw, GLPRT_PXOFFTXC(port, i), 7804b0fdcebSAnirudh Venkataramanan pf->stat_prev_loaded, 7814b0fdcebSAnirudh Venkataramanan &prev_ps->priority_xoff_tx[i], 7824b0fdcebSAnirudh Venkataramanan &cur_ps->priority_xoff_tx[i]); 7839e7a5d17SUsha Ketineni ice_stat_update32(hw, GLPRT_RXON2OFFCNT(port, i), 7844b0fdcebSAnirudh Venkataramanan pf->stat_prev_loaded, 7854b0fdcebSAnirudh Venkataramanan &prev_ps->priority_xon_2_xoff[i], 7864b0fdcebSAnirudh Venkataramanan &cur_ps->priority_xon_2_xoff[i]); 7874b0fdcebSAnirudh Venkataramanan } 7884b0fdcebSAnirudh Venkataramanan } 7894b0fdcebSAnirudh Venkataramanan 7904b0fdcebSAnirudh Venkataramanan /** 7915f6aa50eSAnirudh Venkataramanan * ice_tx_prepare_vlan_flags_dcb - prepare VLAN tagging for DCB 7925f6aa50eSAnirudh Venkataramanan * @tx_ring: ring to send buffer on 7935f6aa50eSAnirudh Venkataramanan * @first: pointer to struct ice_tx_buf 7945f6aa50eSAnirudh Venkataramanan */ 7955f6aa50eSAnirudh Venkataramanan int 7965f6aa50eSAnirudh Venkataramanan ice_tx_prepare_vlan_flags_dcb(struct ice_ring *tx_ring, 7975f6aa50eSAnirudh Venkataramanan struct ice_tx_buf *first) 7985f6aa50eSAnirudh Venkataramanan { 7995f6aa50eSAnirudh Venkataramanan struct sk_buff *skb = first->skb; 8005f6aa50eSAnirudh Venkataramanan 8015f6aa50eSAnirudh Venkataramanan if (!test_bit(ICE_FLAG_DCB_ENA, tx_ring->vsi->back->flags)) 8025f6aa50eSAnirudh Venkataramanan return 0; 8035f6aa50eSAnirudh Venkataramanan 8045f6aa50eSAnirudh Venkataramanan /* Insert 802.1p priority into VLAN header */ 8055f6aa50eSAnirudh Venkataramanan if ((first->tx_flags & (ICE_TX_FLAGS_HW_VLAN | ICE_TX_FLAGS_SW_VLAN)) || 8065f6aa50eSAnirudh Venkataramanan skb->priority != TC_PRIO_CONTROL) { 8075f6aa50eSAnirudh Venkataramanan first->tx_flags &= ~ICE_TX_FLAGS_VLAN_PR_M; 8085f6aa50eSAnirudh Venkataramanan /* Mask the lower 3 bits to set the 802.1p priority */ 8095f6aa50eSAnirudh Venkataramanan first->tx_flags |= (skb->priority & 0x7) << 8105f6aa50eSAnirudh Venkataramanan ICE_TX_FLAGS_VLAN_PR_S; 8115f6aa50eSAnirudh Venkataramanan if (first->tx_flags & ICE_TX_FLAGS_SW_VLAN) { 8125f6aa50eSAnirudh Venkataramanan struct vlan_ethhdr *vhdr; 8135f6aa50eSAnirudh Venkataramanan int rc; 8145f6aa50eSAnirudh Venkataramanan 8155f6aa50eSAnirudh Venkataramanan rc = skb_cow_head(skb, 0); 8165f6aa50eSAnirudh Venkataramanan if (rc < 0) 8175f6aa50eSAnirudh Venkataramanan return rc; 8185f6aa50eSAnirudh Venkataramanan vhdr = (struct vlan_ethhdr *)skb->data; 8195f6aa50eSAnirudh Venkataramanan vhdr->h_vlan_TCI = htons(first->tx_flags >> 8205f6aa50eSAnirudh Venkataramanan ICE_TX_FLAGS_VLAN_S); 8215f6aa50eSAnirudh Venkataramanan } else { 8225f6aa50eSAnirudh Venkataramanan first->tx_flags |= ICE_TX_FLAGS_HW_VLAN; 8235f6aa50eSAnirudh Venkataramanan } 8245f6aa50eSAnirudh Venkataramanan } 8255f6aa50eSAnirudh Venkataramanan 8265f6aa50eSAnirudh Venkataramanan return 0; 8275f6aa50eSAnirudh Venkataramanan } 8285f6aa50eSAnirudh Venkataramanan 8295f6aa50eSAnirudh Venkataramanan /** 83000cc3f1bSAnirudh Venkataramanan * ice_dcb_process_lldp_set_mib_change - Process MIB change 83100cc3f1bSAnirudh Venkataramanan * @pf: ptr to ice_pf 83200cc3f1bSAnirudh Venkataramanan * @event: pointer to the admin queue receive event 83300cc3f1bSAnirudh Venkataramanan */ 83400cc3f1bSAnirudh Venkataramanan void 83500cc3f1bSAnirudh Venkataramanan ice_dcb_process_lldp_set_mib_change(struct ice_pf *pf, 83600cc3f1bSAnirudh Venkataramanan struct ice_rq_event_info *event) 83700cc3f1bSAnirudh Venkataramanan { 838a17a5ff6SUsha Ketineni struct ice_aqc_port_ets_elem buf = { 0 }; 8394015d11eSBrett Creeley struct device *dev = ice_pf_to_dev(pf); 840a17a5ff6SUsha Ketineni struct ice_aqc_lldp_get_mib *mib; 841a17a5ff6SUsha Ketineni struct ice_dcbx_cfg tmp_dcbx_cfg; 842a17a5ff6SUsha Ketineni bool need_reconfig = false; 843a17a5ff6SUsha Ketineni struct ice_port_info *pi; 8449d614b64SAnirudh Venkataramanan struct ice_vsi *pf_vsi; 8456dae8aa0SBruce Allan u8 mib_type; 846a17a5ff6SUsha Ketineni int ret; 84700cc3f1bSAnirudh Venkataramanan 848a17a5ff6SUsha Ketineni /* Not DCB capable or capability disabled */ 849a17a5ff6SUsha Ketineni if (!(test_bit(ICE_FLAG_DCB_CAPABLE, pf->flags))) 85000cc3f1bSAnirudh Venkataramanan return; 85100cc3f1bSAnirudh Venkataramanan 852a17a5ff6SUsha Ketineni if (pf->dcbx_cap & DCB_CAP_DCBX_HOST) { 8534015d11eSBrett Creeley dev_dbg(dev, "MIB Change Event in HOST mode\n"); 854a17a5ff6SUsha Ketineni return; 85500cc3f1bSAnirudh Venkataramanan } 856a17a5ff6SUsha Ketineni 857a17a5ff6SUsha Ketineni pi = pf->hw.port_info; 858a17a5ff6SUsha Ketineni mib = (struct ice_aqc_lldp_get_mib *)&event->desc.params.raw; 859a17a5ff6SUsha Ketineni /* Ignore if event is not for Nearest Bridge */ 8606dae8aa0SBruce Allan mib_type = ((mib->type >> ICE_AQ_LLDP_BRID_TYPE_S) & 861a17a5ff6SUsha Ketineni ICE_AQ_LLDP_BRID_TYPE_M); 8626dae8aa0SBruce Allan dev_dbg(dev, "LLDP event MIB bridge type 0x%x\n", mib_type); 8636dae8aa0SBruce Allan if (mib_type != ICE_AQ_LLDP_BRID_TYPE_NEAREST_BRID) 864a17a5ff6SUsha Ketineni return; 865a17a5ff6SUsha Ketineni 866a17a5ff6SUsha Ketineni /* Check MIB Type and return if event for Remote MIB update */ 8676dae8aa0SBruce Allan mib_type = mib->type & ICE_AQ_LLDP_MIB_TYPE_M; 8686dae8aa0SBruce Allan dev_dbg(dev, "LLDP event mib type %s\n", mib_type ? "remote" : "local"); 8696dae8aa0SBruce Allan if (mib_type == ICE_AQ_LLDP_MIB_REMOTE) { 870a17a5ff6SUsha Ketineni /* Update the remote cached instance and return */ 871a17a5ff6SUsha Ketineni ret = ice_aq_get_dcb_cfg(pi->hw, ICE_AQ_LLDP_MIB_REMOTE, 872a17a5ff6SUsha Ketineni ICE_AQ_LLDP_BRID_TYPE_NEAREST_BRID, 873a17a5ff6SUsha Ketineni &pi->remote_dcbx_cfg); 874a17a5ff6SUsha Ketineni if (ret) { 8754015d11eSBrett Creeley dev_err(dev, "Failed to get remote DCB config\n"); 876a17a5ff6SUsha Ketineni return; 877a17a5ff6SUsha Ketineni } 878a17a5ff6SUsha Ketineni } 879a17a5ff6SUsha Ketineni 880242b5e06SDave Ertman mutex_lock(&pf->tc_mutex); 881242b5e06SDave Ertman 882a17a5ff6SUsha Ketineni /* store the old configuration */ 883a17a5ff6SUsha Ketineni tmp_dcbx_cfg = pf->hw.port_info->local_dcbx_cfg; 884a17a5ff6SUsha Ketineni 8852f2da36eSAnirudh Venkataramanan /* Reset the old DCBX configuration data */ 886a17a5ff6SUsha Ketineni memset(&pi->local_dcbx_cfg, 0, sizeof(pi->local_dcbx_cfg)); 887a17a5ff6SUsha Ketineni 8882f2da36eSAnirudh Venkataramanan /* Get updated DCBX data from firmware */ 889a17a5ff6SUsha Ketineni ret = ice_get_dcb_cfg(pf->hw.port_info); 890a17a5ff6SUsha Ketineni if (ret) { 8914015d11eSBrett Creeley dev_err(dev, "Failed to get DCB config\n"); 892242b5e06SDave Ertman goto out; 893a17a5ff6SUsha Ketineni } 894a17a5ff6SUsha Ketineni 895a17a5ff6SUsha Ketineni /* No change detected in DCBX configs */ 896a17a5ff6SUsha Ketineni if (!memcmp(&tmp_dcbx_cfg, &pi->local_dcbx_cfg, sizeof(tmp_dcbx_cfg))) { 8974015d11eSBrett Creeley dev_dbg(dev, "No change detected in DCBX configuration.\n"); 898242b5e06SDave Ertman goto out; 899a17a5ff6SUsha Ketineni } 900a17a5ff6SUsha Ketineni 9011f454e06SAvinash JD pf->dcbx_cap = ice_dcb_get_mode(pi, false); 9021f454e06SAvinash JD 903a17a5ff6SUsha Ketineni need_reconfig = ice_dcb_need_recfg(pf, &tmp_dcbx_cfg, 904a17a5ff6SUsha Ketineni &pi->local_dcbx_cfg); 905b94b013eSDave Ertman ice_dcbnl_flush_apps(pf, &tmp_dcbx_cfg, &pi->local_dcbx_cfg); 906a17a5ff6SUsha Ketineni if (!need_reconfig) 907242b5e06SDave Ertman goto out; 908a17a5ff6SUsha Ketineni 909a17a5ff6SUsha Ketineni /* Enable DCB tagging only when more than one TC */ 910a17a5ff6SUsha Ketineni if (ice_dcb_get_num_tc(&pi->local_dcbx_cfg) > 1) { 9114015d11eSBrett Creeley dev_dbg(dev, "DCB tagging enabled (num TC > 1)\n"); 912a17a5ff6SUsha Ketineni set_bit(ICE_FLAG_DCB_ENA, pf->flags); 913a17a5ff6SUsha Ketineni } else { 9144015d11eSBrett Creeley dev_dbg(dev, "DCB tagging disabled (num TC = 1)\n"); 915a17a5ff6SUsha Ketineni clear_bit(ICE_FLAG_DCB_ENA, pf->flags); 916a17a5ff6SUsha Ketineni } 917a17a5ff6SUsha Ketineni 9189d614b64SAnirudh Venkataramanan pf_vsi = ice_get_main_vsi(pf); 9199d614b64SAnirudh Venkataramanan if (!pf_vsi) { 9204015d11eSBrett Creeley dev_dbg(dev, "PF VSI doesn't exist\n"); 921242b5e06SDave Ertman goto out; 9229d614b64SAnirudh Venkataramanan } 9239d614b64SAnirudh Venkataramanan 924a17a5ff6SUsha Ketineni rtnl_lock(); 9259d614b64SAnirudh Venkataramanan ice_dis_vsi(pf_vsi, true); 926a17a5ff6SUsha Ketineni 927a17a5ff6SUsha Ketineni ret = ice_query_port_ets(pf->hw.port_info, &buf, sizeof(buf), NULL); 928a17a5ff6SUsha Ketineni if (ret) { 9294015d11eSBrett Creeley dev_err(dev, "Query Port ETS failed\n"); 930242b5e06SDave Ertman goto unlock_rtnl; 931a17a5ff6SUsha Ketineni } 932a17a5ff6SUsha Ketineni 933a17a5ff6SUsha Ketineni /* changes in configuration update VSI */ 934a17a5ff6SUsha Ketineni ice_pf_dcb_recfg(pf); 935a17a5ff6SUsha Ketineni 9369d614b64SAnirudh Venkataramanan ice_ena_vsi(pf_vsi, true); 937242b5e06SDave Ertman unlock_rtnl: 938a17a5ff6SUsha Ketineni rtnl_unlock(); 939242b5e06SDave Ertman out: 940242b5e06SDave Ertman mutex_unlock(&pf->tc_mutex); 94100cc3f1bSAnirudh Venkataramanan } 942