137b6f646SAnirudh Venkataramanan // SPDX-License-Identifier: GPL-2.0
237b6f646SAnirudh Venkataramanan /* Copyright (c) 2019, Intel Corporation. */
337b6f646SAnirudh Venkataramanan
437b6f646SAnirudh Venkataramanan #include "ice_common.h"
537b6f646SAnirudh Venkataramanan #include "ice_sched.h"
637b6f646SAnirudh Venkataramanan #include "ice_dcb.h"
737b6f646SAnirudh Venkataramanan
837b6f646SAnirudh Venkataramanan /**
90ebd3ff1SAnirudh Venkataramanan * ice_aq_get_lldp_mib
100ebd3ff1SAnirudh Venkataramanan * @hw: pointer to the HW struct
110ebd3ff1SAnirudh Venkataramanan * @bridge_type: type of bridge requested
120ebd3ff1SAnirudh Venkataramanan * @mib_type: Local, Remote or both Local and Remote MIBs
130ebd3ff1SAnirudh Venkataramanan * @buf: pointer to the caller-supplied buffer to store the MIB block
140ebd3ff1SAnirudh Venkataramanan * @buf_size: size of the buffer (in bytes)
150ebd3ff1SAnirudh Venkataramanan * @local_len: length of the returned Local LLDP MIB
160ebd3ff1SAnirudh Venkataramanan * @remote_len: length of the returned Remote LLDP MIB
170ebd3ff1SAnirudh Venkataramanan * @cd: pointer to command details structure or NULL
180ebd3ff1SAnirudh Venkataramanan *
190ebd3ff1SAnirudh Venkataramanan * Requests the complete LLDP MIB (entire packet). (0x0A00)
200ebd3ff1SAnirudh Venkataramanan */
215e24d598STony Nguyen static int
ice_aq_get_lldp_mib(struct ice_hw * hw,u8 bridge_type,u8 mib_type,void * buf,u16 buf_size,u16 * local_len,u16 * remote_len,struct ice_sq_cd * cd)220ebd3ff1SAnirudh Venkataramanan ice_aq_get_lldp_mib(struct ice_hw *hw, u8 bridge_type, u8 mib_type, void *buf,
230ebd3ff1SAnirudh Venkataramanan u16 buf_size, u16 *local_len, u16 *remote_len,
240ebd3ff1SAnirudh Venkataramanan struct ice_sq_cd *cd)
250ebd3ff1SAnirudh Venkataramanan {
260ebd3ff1SAnirudh Venkataramanan struct ice_aqc_lldp_get_mib *cmd;
270ebd3ff1SAnirudh Venkataramanan struct ice_aq_desc desc;
285e24d598STony Nguyen int status;
290ebd3ff1SAnirudh Venkataramanan
300ebd3ff1SAnirudh Venkataramanan cmd = &desc.params.lldp_get_mib;
310ebd3ff1SAnirudh Venkataramanan
320ebd3ff1SAnirudh Venkataramanan if (buf_size == 0 || !buf)
33d54699e2STony Nguyen return -EINVAL;
340ebd3ff1SAnirudh Venkataramanan
350ebd3ff1SAnirudh Venkataramanan ice_fill_dflt_direct_cmd_desc(&desc, ice_aqc_opc_lldp_get_mib);
360ebd3ff1SAnirudh Venkataramanan
370ebd3ff1SAnirudh Venkataramanan cmd->type = mib_type & ICE_AQ_LLDP_MIB_TYPE_M;
380ebd3ff1SAnirudh Venkataramanan cmd->type |= (bridge_type << ICE_AQ_LLDP_BRID_TYPE_S) &
390ebd3ff1SAnirudh Venkataramanan ICE_AQ_LLDP_BRID_TYPE_M;
400ebd3ff1SAnirudh Venkataramanan
410ebd3ff1SAnirudh Venkataramanan desc.datalen = cpu_to_le16(buf_size);
420ebd3ff1SAnirudh Venkataramanan
430ebd3ff1SAnirudh Venkataramanan status = ice_aq_send_cmd(hw, &desc, buf, buf_size, cd);
440ebd3ff1SAnirudh Venkataramanan if (!status) {
450ebd3ff1SAnirudh Venkataramanan if (local_len)
460ebd3ff1SAnirudh Venkataramanan *local_len = le16_to_cpu(cmd->local_len);
470ebd3ff1SAnirudh Venkataramanan if (remote_len)
480ebd3ff1SAnirudh Venkataramanan *remote_len = le16_to_cpu(cmd->remote_len);
490ebd3ff1SAnirudh Venkataramanan }
500ebd3ff1SAnirudh Venkataramanan
510ebd3ff1SAnirudh Venkataramanan return status;
520ebd3ff1SAnirudh Venkataramanan }
530ebd3ff1SAnirudh Venkataramanan
540ebd3ff1SAnirudh Venkataramanan /**
550ebd3ff1SAnirudh Venkataramanan * ice_aq_cfg_lldp_mib_change
560ebd3ff1SAnirudh Venkataramanan * @hw: pointer to the HW struct
570ebd3ff1SAnirudh Venkataramanan * @ena_update: Enable or Disable event posting
580ebd3ff1SAnirudh Venkataramanan * @cd: pointer to command details structure or NULL
590ebd3ff1SAnirudh Venkataramanan *
600ebd3ff1SAnirudh Venkataramanan * Enable or Disable posting of an event on ARQ when LLDP MIB
610ebd3ff1SAnirudh Venkataramanan * associated with the interface changes (0x0A01)
620ebd3ff1SAnirudh Venkataramanan */
635e24d598STony Nguyen static int
ice_aq_cfg_lldp_mib_change(struct ice_hw * hw,bool ena_update,struct ice_sq_cd * cd)640ebd3ff1SAnirudh Venkataramanan ice_aq_cfg_lldp_mib_change(struct ice_hw *hw, bool ena_update,
650ebd3ff1SAnirudh Venkataramanan struct ice_sq_cd *cd)
660ebd3ff1SAnirudh Venkataramanan {
670ebd3ff1SAnirudh Venkataramanan struct ice_aqc_lldp_set_mib_change *cmd;
680ebd3ff1SAnirudh Venkataramanan struct ice_aq_desc desc;
690ebd3ff1SAnirudh Venkataramanan
700ebd3ff1SAnirudh Venkataramanan cmd = &desc.params.lldp_set_event;
710ebd3ff1SAnirudh Venkataramanan
720ebd3ff1SAnirudh Venkataramanan ice_fill_dflt_direct_cmd_desc(&desc, ice_aqc_opc_lldp_set_mib_change);
730ebd3ff1SAnirudh Venkataramanan
740ebd3ff1SAnirudh Venkataramanan if (!ena_update)
750ebd3ff1SAnirudh Venkataramanan cmd->command |= ICE_AQ_LLDP_MIB_UPDATE_DIS;
76a4f68f37STsotne Chakhvadze else
77a4f68f37STsotne Chakhvadze cmd->command |= FIELD_PREP(ICE_AQ_LLDP_MIB_PENDING_M,
78a4f68f37STsotne Chakhvadze ICE_AQ_LLDP_MIB_PENDING_ENABLE);
790ebd3ff1SAnirudh Venkataramanan
800ebd3ff1SAnirudh Venkataramanan return ice_aq_send_cmd(hw, &desc, NULL, 0, cd);
810ebd3ff1SAnirudh Venkataramanan }
820ebd3ff1SAnirudh Venkataramanan
830ebd3ff1SAnirudh Venkataramanan /**
843a257a14SAnirudh Venkataramanan * ice_aq_stop_lldp
853a257a14SAnirudh Venkataramanan * @hw: pointer to the HW struct
863a257a14SAnirudh Venkataramanan * @shutdown_lldp_agent: True if LLDP Agent needs to be Shutdown
873a257a14SAnirudh Venkataramanan * False if LLDP Agent needs to be Stopped
8831eafa40SAnirudh Venkataramanan * @persist: True if Stop/Shutdown of LLDP Agent needs to be persistent across
8931eafa40SAnirudh Venkataramanan * reboots
903a257a14SAnirudh Venkataramanan * @cd: pointer to command details structure or NULL
913a257a14SAnirudh Venkataramanan *
923a257a14SAnirudh Venkataramanan * Stop or Shutdown the embedded LLDP Agent (0x0A05)
933a257a14SAnirudh Venkataramanan */
945e24d598STony Nguyen int
ice_aq_stop_lldp(struct ice_hw * hw,bool shutdown_lldp_agent,bool persist,struct ice_sq_cd * cd)9531eafa40SAnirudh Venkataramanan ice_aq_stop_lldp(struct ice_hw *hw, bool shutdown_lldp_agent, bool persist,
963a257a14SAnirudh Venkataramanan struct ice_sq_cd *cd)
973a257a14SAnirudh Venkataramanan {
983a257a14SAnirudh Venkataramanan struct ice_aqc_lldp_stop *cmd;
993a257a14SAnirudh Venkataramanan struct ice_aq_desc desc;
1003a257a14SAnirudh Venkataramanan
1013a257a14SAnirudh Venkataramanan cmd = &desc.params.lldp_stop;
1023a257a14SAnirudh Venkataramanan
1033a257a14SAnirudh Venkataramanan ice_fill_dflt_direct_cmd_desc(&desc, ice_aqc_opc_lldp_stop);
1043a257a14SAnirudh Venkataramanan
1053a257a14SAnirudh Venkataramanan if (shutdown_lldp_agent)
1063a257a14SAnirudh Venkataramanan cmd->command |= ICE_AQ_LLDP_AGENT_SHUTDOWN;
1073a257a14SAnirudh Venkataramanan
10831eafa40SAnirudh Venkataramanan if (persist)
10931eafa40SAnirudh Venkataramanan cmd->command |= ICE_AQ_LLDP_AGENT_PERSIST_DIS;
11031eafa40SAnirudh Venkataramanan
1113a257a14SAnirudh Venkataramanan return ice_aq_send_cmd(hw, &desc, NULL, 0, cd);
1123a257a14SAnirudh Venkataramanan }
1133a257a14SAnirudh Venkataramanan
1143a257a14SAnirudh Venkataramanan /**
11537b6f646SAnirudh Venkataramanan * ice_aq_start_lldp
11637b6f646SAnirudh Venkataramanan * @hw: pointer to the HW struct
11731eafa40SAnirudh Venkataramanan * @persist: True if Start of LLDP Agent needs to be persistent across reboots
11837b6f646SAnirudh Venkataramanan * @cd: pointer to command details structure or NULL
11937b6f646SAnirudh Venkataramanan *
12037b6f646SAnirudh Venkataramanan * Start the embedded LLDP Agent on all ports. (0x0A06)
12137b6f646SAnirudh Venkataramanan */
ice_aq_start_lldp(struct ice_hw * hw,bool persist,struct ice_sq_cd * cd)1225518ac2aSTony Nguyen int ice_aq_start_lldp(struct ice_hw *hw, bool persist, struct ice_sq_cd *cd)
12337b6f646SAnirudh Venkataramanan {
12437b6f646SAnirudh Venkataramanan struct ice_aqc_lldp_start *cmd;
12537b6f646SAnirudh Venkataramanan struct ice_aq_desc desc;
12637b6f646SAnirudh Venkataramanan
12737b6f646SAnirudh Venkataramanan cmd = &desc.params.lldp_start;
12837b6f646SAnirudh Venkataramanan
12937b6f646SAnirudh Venkataramanan ice_fill_dflt_direct_cmd_desc(&desc, ice_aqc_opc_lldp_start);
13037b6f646SAnirudh Venkataramanan
13137b6f646SAnirudh Venkataramanan cmd->command = ICE_AQ_LLDP_AGENT_START;
13237b6f646SAnirudh Venkataramanan
13331eafa40SAnirudh Venkataramanan if (persist)
13431eafa40SAnirudh Venkataramanan cmd->command |= ICE_AQ_LLDP_AGENT_PERSIST_ENA;
13531eafa40SAnirudh Venkataramanan
13637b6f646SAnirudh Venkataramanan return ice_aq_send_cmd(hw, &desc, NULL, 0, cd);
13737b6f646SAnirudh Venkataramanan }
13837b6f646SAnirudh Venkataramanan
13937b6f646SAnirudh Venkataramanan /**
14037b6f646SAnirudh Venkataramanan * ice_get_dcbx_status
14137b6f646SAnirudh Venkataramanan * @hw: pointer to the HW struct
14237b6f646SAnirudh Venkataramanan *
14337b6f646SAnirudh Venkataramanan * Get the DCBX status from the Firmware
14437b6f646SAnirudh Venkataramanan */
ice_get_dcbx_status(struct ice_hw * hw)14531eafa40SAnirudh Venkataramanan static u8 ice_get_dcbx_status(struct ice_hw *hw)
14637b6f646SAnirudh Venkataramanan {
14737b6f646SAnirudh Venkataramanan u32 reg;
14837b6f646SAnirudh Venkataramanan
14937b6f646SAnirudh Venkataramanan reg = rd32(hw, PRTDCB_GENS);
15037b6f646SAnirudh Venkataramanan return (u8)((reg & PRTDCB_GENS_DCBX_STATUS_M) >>
15137b6f646SAnirudh Venkataramanan PRTDCB_GENS_DCBX_STATUS_S);
15237b6f646SAnirudh Venkataramanan }
15337b6f646SAnirudh Venkataramanan
15437b6f646SAnirudh Venkataramanan /**
1550ebd3ff1SAnirudh Venkataramanan * ice_parse_ieee_ets_common_tlv
1560ebd3ff1SAnirudh Venkataramanan * @buf: Data buffer to be parsed for ETS CFG/REC data
1570ebd3ff1SAnirudh Venkataramanan * @ets_cfg: Container to store parsed data
1580ebd3ff1SAnirudh Venkataramanan *
1590ebd3ff1SAnirudh Venkataramanan * Parses the common data of IEEE 802.1Qaz ETS CFG/REC TLV
1600ebd3ff1SAnirudh Venkataramanan */
1610ebd3ff1SAnirudh Venkataramanan static void
ice_parse_ieee_ets_common_tlv(u8 * buf,struct ice_dcb_ets_cfg * ets_cfg)1620ebd3ff1SAnirudh Venkataramanan ice_parse_ieee_ets_common_tlv(u8 *buf, struct ice_dcb_ets_cfg *ets_cfg)
1630ebd3ff1SAnirudh Venkataramanan {
1640ebd3ff1SAnirudh Venkataramanan u8 offset = 0;
1650ebd3ff1SAnirudh Venkataramanan int i;
1660ebd3ff1SAnirudh Venkataramanan
1670ebd3ff1SAnirudh Venkataramanan /* Priority Assignment Table (4 octets)
1680ebd3ff1SAnirudh Venkataramanan * Octets:| 1 | 2 | 3 | 4 |
1690ebd3ff1SAnirudh Venkataramanan * -----------------------------------------
1700ebd3ff1SAnirudh Venkataramanan * |pri0|pri1|pri2|pri3|pri4|pri5|pri6|pri7|
1710ebd3ff1SAnirudh Venkataramanan * -----------------------------------------
1720ebd3ff1SAnirudh Venkataramanan * Bits:|7 4|3 0|7 4|3 0|7 4|3 0|7 4|3 0|
1730ebd3ff1SAnirudh Venkataramanan * -----------------------------------------
1740ebd3ff1SAnirudh Venkataramanan */
1750ebd3ff1SAnirudh Venkataramanan for (i = 0; i < 4; i++) {
1760ebd3ff1SAnirudh Venkataramanan ets_cfg->prio_table[i * 2] =
1770ebd3ff1SAnirudh Venkataramanan ((buf[offset] & ICE_IEEE_ETS_PRIO_1_M) >>
1780ebd3ff1SAnirudh Venkataramanan ICE_IEEE_ETS_PRIO_1_S);
1790ebd3ff1SAnirudh Venkataramanan ets_cfg->prio_table[i * 2 + 1] =
1800ebd3ff1SAnirudh Venkataramanan ((buf[offset] & ICE_IEEE_ETS_PRIO_0_M) >>
1810ebd3ff1SAnirudh Venkataramanan ICE_IEEE_ETS_PRIO_0_S);
1820ebd3ff1SAnirudh Venkataramanan offset++;
1830ebd3ff1SAnirudh Venkataramanan }
1840ebd3ff1SAnirudh Venkataramanan
1850ebd3ff1SAnirudh Venkataramanan /* TC Bandwidth Table (8 octets)
1860ebd3ff1SAnirudh Venkataramanan * Octets:| 1 | 2 | 3 | 4 | 5 | 6 | 7 | 8 |
1870ebd3ff1SAnirudh Venkataramanan * ---------------------------------
1880ebd3ff1SAnirudh Venkataramanan * |tc0|tc1|tc2|tc3|tc4|tc5|tc6|tc7|
1890ebd3ff1SAnirudh Venkataramanan * ---------------------------------
1900ebd3ff1SAnirudh Venkataramanan *
1910ebd3ff1SAnirudh Venkataramanan * TSA Assignment Table (8 octets)
1920ebd3ff1SAnirudh Venkataramanan * Octets:| 9 | 10| 11| 12| 13| 14| 15| 16|
1930ebd3ff1SAnirudh Venkataramanan * ---------------------------------
1940ebd3ff1SAnirudh Venkataramanan * |tc0|tc1|tc2|tc3|tc4|tc5|tc6|tc7|
1950ebd3ff1SAnirudh Venkataramanan * ---------------------------------
1960ebd3ff1SAnirudh Venkataramanan */
1970ebd3ff1SAnirudh Venkataramanan ice_for_each_traffic_class(i) {
1980ebd3ff1SAnirudh Venkataramanan ets_cfg->tcbwtable[i] = buf[offset];
1990ebd3ff1SAnirudh Venkataramanan ets_cfg->tsatable[i] = buf[ICE_MAX_TRAFFIC_CLASS + offset++];
2000ebd3ff1SAnirudh Venkataramanan }
2010ebd3ff1SAnirudh Venkataramanan }
2020ebd3ff1SAnirudh Venkataramanan
2030ebd3ff1SAnirudh Venkataramanan /**
2040ebd3ff1SAnirudh Venkataramanan * ice_parse_ieee_etscfg_tlv
2050ebd3ff1SAnirudh Venkataramanan * @tlv: IEEE 802.1Qaz ETS CFG TLV
2060ebd3ff1SAnirudh Venkataramanan * @dcbcfg: Local store to update ETS CFG data
2070ebd3ff1SAnirudh Venkataramanan *
2080ebd3ff1SAnirudh Venkataramanan * Parses IEEE 802.1Qaz ETS CFG TLV
2090ebd3ff1SAnirudh Venkataramanan */
2100ebd3ff1SAnirudh Venkataramanan static void
ice_parse_ieee_etscfg_tlv(struct ice_lldp_org_tlv * tlv,struct ice_dcbx_cfg * dcbcfg)2110ebd3ff1SAnirudh Venkataramanan ice_parse_ieee_etscfg_tlv(struct ice_lldp_org_tlv *tlv,
2120ebd3ff1SAnirudh Venkataramanan struct ice_dcbx_cfg *dcbcfg)
2130ebd3ff1SAnirudh Venkataramanan {
2140ebd3ff1SAnirudh Venkataramanan struct ice_dcb_ets_cfg *etscfg;
2150ebd3ff1SAnirudh Venkataramanan u8 *buf = tlv->tlvinfo;
2160ebd3ff1SAnirudh Venkataramanan
2170ebd3ff1SAnirudh Venkataramanan /* First Octet post subtype
2180ebd3ff1SAnirudh Venkataramanan * --------------------------
2190ebd3ff1SAnirudh Venkataramanan * |will-|CBS | Re- | Max |
2200ebd3ff1SAnirudh Venkataramanan * |ing | |served| TCs |
2210ebd3ff1SAnirudh Venkataramanan * --------------------------
2220ebd3ff1SAnirudh Venkataramanan * |1bit | 1bit|3 bits|3bits|
2230ebd3ff1SAnirudh Venkataramanan */
2240ebd3ff1SAnirudh Venkataramanan etscfg = &dcbcfg->etscfg;
2250ebd3ff1SAnirudh Venkataramanan etscfg->willing = ((buf[0] & ICE_IEEE_ETS_WILLING_M) >>
2260ebd3ff1SAnirudh Venkataramanan ICE_IEEE_ETS_WILLING_S);
2270ebd3ff1SAnirudh Venkataramanan etscfg->cbs = ((buf[0] & ICE_IEEE_ETS_CBS_M) >> ICE_IEEE_ETS_CBS_S);
2280ebd3ff1SAnirudh Venkataramanan etscfg->maxtcs = ((buf[0] & ICE_IEEE_ETS_MAXTC_M) >>
2290ebd3ff1SAnirudh Venkataramanan ICE_IEEE_ETS_MAXTC_S);
2300ebd3ff1SAnirudh Venkataramanan
2310ebd3ff1SAnirudh Venkataramanan /* Begin parsing at Priority Assignment Table (offset 1 in buf) */
2320ebd3ff1SAnirudh Venkataramanan ice_parse_ieee_ets_common_tlv(&buf[1], etscfg);
2330ebd3ff1SAnirudh Venkataramanan }
2340ebd3ff1SAnirudh Venkataramanan
2350ebd3ff1SAnirudh Venkataramanan /**
2360ebd3ff1SAnirudh Venkataramanan * ice_parse_ieee_etsrec_tlv
2370ebd3ff1SAnirudh Venkataramanan * @tlv: IEEE 802.1Qaz ETS REC TLV
2380ebd3ff1SAnirudh Venkataramanan * @dcbcfg: Local store to update ETS REC data
2390ebd3ff1SAnirudh Venkataramanan *
2400ebd3ff1SAnirudh Venkataramanan * Parses IEEE 802.1Qaz ETS REC TLV
2410ebd3ff1SAnirudh Venkataramanan */
2420ebd3ff1SAnirudh Venkataramanan static void
ice_parse_ieee_etsrec_tlv(struct ice_lldp_org_tlv * tlv,struct ice_dcbx_cfg * dcbcfg)2430ebd3ff1SAnirudh Venkataramanan ice_parse_ieee_etsrec_tlv(struct ice_lldp_org_tlv *tlv,
2440ebd3ff1SAnirudh Venkataramanan struct ice_dcbx_cfg *dcbcfg)
2450ebd3ff1SAnirudh Venkataramanan {
2460ebd3ff1SAnirudh Venkataramanan u8 *buf = tlv->tlvinfo;
2470ebd3ff1SAnirudh Venkataramanan
2480ebd3ff1SAnirudh Venkataramanan /* Begin parsing at Priority Assignment Table (offset 1 in buf) */
2490ebd3ff1SAnirudh Venkataramanan ice_parse_ieee_ets_common_tlv(&buf[1], &dcbcfg->etsrec);
2500ebd3ff1SAnirudh Venkataramanan }
2510ebd3ff1SAnirudh Venkataramanan
2520ebd3ff1SAnirudh Venkataramanan /**
2530ebd3ff1SAnirudh Venkataramanan * ice_parse_ieee_pfccfg_tlv
2540ebd3ff1SAnirudh Venkataramanan * @tlv: IEEE 802.1Qaz PFC CFG TLV
2550ebd3ff1SAnirudh Venkataramanan * @dcbcfg: Local store to update PFC CFG data
2560ebd3ff1SAnirudh Venkataramanan *
2570ebd3ff1SAnirudh Venkataramanan * Parses IEEE 802.1Qaz PFC CFG TLV
2580ebd3ff1SAnirudh Venkataramanan */
2590ebd3ff1SAnirudh Venkataramanan static void
ice_parse_ieee_pfccfg_tlv(struct ice_lldp_org_tlv * tlv,struct ice_dcbx_cfg * dcbcfg)2600ebd3ff1SAnirudh Venkataramanan ice_parse_ieee_pfccfg_tlv(struct ice_lldp_org_tlv *tlv,
2610ebd3ff1SAnirudh Venkataramanan struct ice_dcbx_cfg *dcbcfg)
2620ebd3ff1SAnirudh Venkataramanan {
2630ebd3ff1SAnirudh Venkataramanan u8 *buf = tlv->tlvinfo;
2640ebd3ff1SAnirudh Venkataramanan
2650ebd3ff1SAnirudh Venkataramanan /* ----------------------------------------
2660ebd3ff1SAnirudh Venkataramanan * |will-|MBC | Re- | PFC | PFC Enable |
2670ebd3ff1SAnirudh Venkataramanan * |ing | |served| cap | |
2680ebd3ff1SAnirudh Venkataramanan * -----------------------------------------
2690ebd3ff1SAnirudh Venkataramanan * |1bit | 1bit|2 bits|4bits| 1 octet |
2700ebd3ff1SAnirudh Venkataramanan */
2710ebd3ff1SAnirudh Venkataramanan dcbcfg->pfc.willing = ((buf[0] & ICE_IEEE_PFC_WILLING_M) >>
2720ebd3ff1SAnirudh Venkataramanan ICE_IEEE_PFC_WILLING_S);
2730ebd3ff1SAnirudh Venkataramanan dcbcfg->pfc.mbc = ((buf[0] & ICE_IEEE_PFC_MBC_M) >> ICE_IEEE_PFC_MBC_S);
2740ebd3ff1SAnirudh Venkataramanan dcbcfg->pfc.pfccap = ((buf[0] & ICE_IEEE_PFC_CAP_M) >>
2750ebd3ff1SAnirudh Venkataramanan ICE_IEEE_PFC_CAP_S);
2760ebd3ff1SAnirudh Venkataramanan dcbcfg->pfc.pfcena = buf[1];
2770ebd3ff1SAnirudh Venkataramanan }
2780ebd3ff1SAnirudh Venkataramanan
2790ebd3ff1SAnirudh Venkataramanan /**
2800ebd3ff1SAnirudh Venkataramanan * ice_parse_ieee_app_tlv
2810ebd3ff1SAnirudh Venkataramanan * @tlv: IEEE 802.1Qaz APP TLV
2820ebd3ff1SAnirudh Venkataramanan * @dcbcfg: Local store to update APP PRIO data
2830ebd3ff1SAnirudh Venkataramanan *
2840ebd3ff1SAnirudh Venkataramanan * Parses IEEE 802.1Qaz APP PRIO TLV
2850ebd3ff1SAnirudh Venkataramanan */
2860ebd3ff1SAnirudh Venkataramanan static void
ice_parse_ieee_app_tlv(struct ice_lldp_org_tlv * tlv,struct ice_dcbx_cfg * dcbcfg)2870ebd3ff1SAnirudh Venkataramanan ice_parse_ieee_app_tlv(struct ice_lldp_org_tlv *tlv,
2880ebd3ff1SAnirudh Venkataramanan struct ice_dcbx_cfg *dcbcfg)
2890ebd3ff1SAnirudh Venkataramanan {
2900ebd3ff1SAnirudh Venkataramanan u16 offset = 0;
2910ebd3ff1SAnirudh Venkataramanan u16 typelen;
2920ebd3ff1SAnirudh Venkataramanan int i = 0;
2930ebd3ff1SAnirudh Venkataramanan u16 len;
2940ebd3ff1SAnirudh Venkataramanan u8 *buf;
2950ebd3ff1SAnirudh Venkataramanan
2960ebd3ff1SAnirudh Venkataramanan typelen = ntohs(tlv->typelen);
2970ebd3ff1SAnirudh Venkataramanan len = ((typelen & ICE_LLDP_TLV_LEN_M) >> ICE_LLDP_TLV_LEN_S);
2980ebd3ff1SAnirudh Venkataramanan buf = tlv->tlvinfo;
2990ebd3ff1SAnirudh Venkataramanan
3000ebd3ff1SAnirudh Venkataramanan /* Removing sizeof(ouisubtype) and reserved byte from len.
3010ebd3ff1SAnirudh Venkataramanan * Remaining len div 3 is number of APP TLVs.
3020ebd3ff1SAnirudh Venkataramanan */
3030ebd3ff1SAnirudh Venkataramanan len -= (sizeof(tlv->ouisubtype) + 1);
3040ebd3ff1SAnirudh Venkataramanan
3050ebd3ff1SAnirudh Venkataramanan /* Move offset to App Priority Table */
3060ebd3ff1SAnirudh Venkataramanan offset++;
3070ebd3ff1SAnirudh Venkataramanan
3080ebd3ff1SAnirudh Venkataramanan /* Application Priority Table (3 octets)
3090ebd3ff1SAnirudh Venkataramanan * Octets:| 1 | 2 | 3 |
3100ebd3ff1SAnirudh Venkataramanan * -----------------------------------------
3110ebd3ff1SAnirudh Venkataramanan * |Priority|Rsrvd| Sel | Protocol ID |
3120ebd3ff1SAnirudh Venkataramanan * -----------------------------------------
3130ebd3ff1SAnirudh Venkataramanan * Bits:|23 21|20 19|18 16|15 0|
3140ebd3ff1SAnirudh Venkataramanan * -----------------------------------------
3150ebd3ff1SAnirudh Venkataramanan */
3160ebd3ff1SAnirudh Venkataramanan while (offset < len) {
3170ebd3ff1SAnirudh Venkataramanan dcbcfg->app[i].priority = ((buf[offset] &
3180ebd3ff1SAnirudh Venkataramanan ICE_IEEE_APP_PRIO_M) >>
3190ebd3ff1SAnirudh Venkataramanan ICE_IEEE_APP_PRIO_S);
3200ebd3ff1SAnirudh Venkataramanan dcbcfg->app[i].selector = ((buf[offset] &
3210ebd3ff1SAnirudh Venkataramanan ICE_IEEE_APP_SEL_M) >>
3220ebd3ff1SAnirudh Venkataramanan ICE_IEEE_APP_SEL_S);
3230ebd3ff1SAnirudh Venkataramanan dcbcfg->app[i].prot_id = (buf[offset + 1] << 0x8) |
3240ebd3ff1SAnirudh Venkataramanan buf[offset + 2];
3250ebd3ff1SAnirudh Venkataramanan /* Move to next app */
3260ebd3ff1SAnirudh Venkataramanan offset += 3;
3270ebd3ff1SAnirudh Venkataramanan i++;
3280ebd3ff1SAnirudh Venkataramanan if (i >= ICE_DCBX_MAX_APPS)
3290ebd3ff1SAnirudh Venkataramanan break;
3300ebd3ff1SAnirudh Venkataramanan }
3310ebd3ff1SAnirudh Venkataramanan
3320ebd3ff1SAnirudh Venkataramanan dcbcfg->numapps = i;
3330ebd3ff1SAnirudh Venkataramanan }
3340ebd3ff1SAnirudh Venkataramanan
3350ebd3ff1SAnirudh Venkataramanan /**
3360ebd3ff1SAnirudh Venkataramanan * ice_parse_ieee_tlv
3370ebd3ff1SAnirudh Venkataramanan * @tlv: IEEE 802.1Qaz TLV
3380ebd3ff1SAnirudh Venkataramanan * @dcbcfg: Local store to update ETS REC data
3390ebd3ff1SAnirudh Venkataramanan *
3400ebd3ff1SAnirudh Venkataramanan * Get the TLV subtype and send it to parsing function
3410ebd3ff1SAnirudh Venkataramanan * based on the subtype value
3420ebd3ff1SAnirudh Venkataramanan */
3430ebd3ff1SAnirudh Venkataramanan static void
ice_parse_ieee_tlv(struct ice_lldp_org_tlv * tlv,struct ice_dcbx_cfg * dcbcfg)3440ebd3ff1SAnirudh Venkataramanan ice_parse_ieee_tlv(struct ice_lldp_org_tlv *tlv, struct ice_dcbx_cfg *dcbcfg)
3450ebd3ff1SAnirudh Venkataramanan {
3460ebd3ff1SAnirudh Venkataramanan u32 ouisubtype;
3470ebd3ff1SAnirudh Venkataramanan u8 subtype;
3480ebd3ff1SAnirudh Venkataramanan
3490ebd3ff1SAnirudh Venkataramanan ouisubtype = ntohl(tlv->ouisubtype);
3500ebd3ff1SAnirudh Venkataramanan subtype = (u8)((ouisubtype & ICE_LLDP_TLV_SUBTYPE_M) >>
3510ebd3ff1SAnirudh Venkataramanan ICE_LLDP_TLV_SUBTYPE_S);
3520ebd3ff1SAnirudh Venkataramanan switch (subtype) {
3530ebd3ff1SAnirudh Venkataramanan case ICE_IEEE_SUBTYPE_ETS_CFG:
3540ebd3ff1SAnirudh Venkataramanan ice_parse_ieee_etscfg_tlv(tlv, dcbcfg);
3550ebd3ff1SAnirudh Venkataramanan break;
3560ebd3ff1SAnirudh Venkataramanan case ICE_IEEE_SUBTYPE_ETS_REC:
3570ebd3ff1SAnirudh Venkataramanan ice_parse_ieee_etsrec_tlv(tlv, dcbcfg);
3580ebd3ff1SAnirudh Venkataramanan break;
3590ebd3ff1SAnirudh Venkataramanan case ICE_IEEE_SUBTYPE_PFC_CFG:
3600ebd3ff1SAnirudh Venkataramanan ice_parse_ieee_pfccfg_tlv(tlv, dcbcfg);
3610ebd3ff1SAnirudh Venkataramanan break;
3620ebd3ff1SAnirudh Venkataramanan case ICE_IEEE_SUBTYPE_APP_PRI:
3630ebd3ff1SAnirudh Venkataramanan ice_parse_ieee_app_tlv(tlv, dcbcfg);
3640ebd3ff1SAnirudh Venkataramanan break;
3650ebd3ff1SAnirudh Venkataramanan default:
3660ebd3ff1SAnirudh Venkataramanan break;
3670ebd3ff1SAnirudh Venkataramanan }
3680ebd3ff1SAnirudh Venkataramanan }
3690ebd3ff1SAnirudh Venkataramanan
3700ebd3ff1SAnirudh Venkataramanan /**
3710ebd3ff1SAnirudh Venkataramanan * ice_parse_cee_pgcfg_tlv
3720ebd3ff1SAnirudh Venkataramanan * @tlv: CEE DCBX PG CFG TLV
3730ebd3ff1SAnirudh Venkataramanan * @dcbcfg: Local store to update ETS CFG data
3740ebd3ff1SAnirudh Venkataramanan *
3750ebd3ff1SAnirudh Venkataramanan * Parses CEE DCBX PG CFG TLV
3760ebd3ff1SAnirudh Venkataramanan */
3770ebd3ff1SAnirudh Venkataramanan static void
ice_parse_cee_pgcfg_tlv(struct ice_cee_feat_tlv * tlv,struct ice_dcbx_cfg * dcbcfg)3780ebd3ff1SAnirudh Venkataramanan ice_parse_cee_pgcfg_tlv(struct ice_cee_feat_tlv *tlv,
3790ebd3ff1SAnirudh Venkataramanan struct ice_dcbx_cfg *dcbcfg)
3800ebd3ff1SAnirudh Venkataramanan {
3810ebd3ff1SAnirudh Venkataramanan struct ice_dcb_ets_cfg *etscfg;
3820ebd3ff1SAnirudh Venkataramanan u8 *buf = tlv->tlvinfo;
3830ebd3ff1SAnirudh Venkataramanan u16 offset = 0;
3840ebd3ff1SAnirudh Venkataramanan int i;
3850ebd3ff1SAnirudh Venkataramanan
3860ebd3ff1SAnirudh Venkataramanan etscfg = &dcbcfg->etscfg;
3870ebd3ff1SAnirudh Venkataramanan
3880ebd3ff1SAnirudh Venkataramanan if (tlv->en_will_err & ICE_CEE_FEAT_TLV_WILLING_M)
3890ebd3ff1SAnirudh Venkataramanan etscfg->willing = 1;
3900ebd3ff1SAnirudh Venkataramanan
3910ebd3ff1SAnirudh Venkataramanan etscfg->cbs = 0;
3920ebd3ff1SAnirudh Venkataramanan /* Priority Group Table (4 octets)
3930ebd3ff1SAnirudh Venkataramanan * Octets:| 1 | 2 | 3 | 4 |
3940ebd3ff1SAnirudh Venkataramanan * -----------------------------------------
3950ebd3ff1SAnirudh Venkataramanan * |pri0|pri1|pri2|pri3|pri4|pri5|pri6|pri7|
3960ebd3ff1SAnirudh Venkataramanan * -----------------------------------------
3970ebd3ff1SAnirudh Venkataramanan * Bits:|7 4|3 0|7 4|3 0|7 4|3 0|7 4|3 0|
3980ebd3ff1SAnirudh Venkataramanan * -----------------------------------------
3990ebd3ff1SAnirudh Venkataramanan */
4000ebd3ff1SAnirudh Venkataramanan for (i = 0; i < 4; i++) {
4010ebd3ff1SAnirudh Venkataramanan etscfg->prio_table[i * 2] =
4020ebd3ff1SAnirudh Venkataramanan ((buf[offset] & ICE_CEE_PGID_PRIO_1_M) >>
4030ebd3ff1SAnirudh Venkataramanan ICE_CEE_PGID_PRIO_1_S);
4040ebd3ff1SAnirudh Venkataramanan etscfg->prio_table[i * 2 + 1] =
4050ebd3ff1SAnirudh Venkataramanan ((buf[offset] & ICE_CEE_PGID_PRIO_0_M) >>
4060ebd3ff1SAnirudh Venkataramanan ICE_CEE_PGID_PRIO_0_S);
4070ebd3ff1SAnirudh Venkataramanan offset++;
4080ebd3ff1SAnirudh Venkataramanan }
4090ebd3ff1SAnirudh Venkataramanan
4100ebd3ff1SAnirudh Venkataramanan /* PG Percentage Table (8 octets)
4110ebd3ff1SAnirudh Venkataramanan * Octets:| 1 | 2 | 3 | 4 | 5 | 6 | 7 | 8 |
4120ebd3ff1SAnirudh Venkataramanan * ---------------------------------
4130ebd3ff1SAnirudh Venkataramanan * |pg0|pg1|pg2|pg3|pg4|pg5|pg6|pg7|
4140ebd3ff1SAnirudh Venkataramanan * ---------------------------------
4150ebd3ff1SAnirudh Venkataramanan */
416d24ef08aSChinh T Cao ice_for_each_traffic_class(i) {
4170ebd3ff1SAnirudh Venkataramanan etscfg->tcbwtable[i] = buf[offset++];
4180ebd3ff1SAnirudh Venkataramanan
419d24ef08aSChinh T Cao if (etscfg->prio_table[i] == ICE_CEE_PGID_STRICT)
420d24ef08aSChinh T Cao dcbcfg->etscfg.tsatable[i] = ICE_IEEE_TSA_STRICT;
421d24ef08aSChinh T Cao else
422d24ef08aSChinh T Cao dcbcfg->etscfg.tsatable[i] = ICE_IEEE_TSA_ETS;
423d24ef08aSChinh T Cao }
424d24ef08aSChinh T Cao
4250ebd3ff1SAnirudh Venkataramanan /* Number of TCs supported (1 octet) */
4260ebd3ff1SAnirudh Venkataramanan etscfg->maxtcs = buf[offset];
4270ebd3ff1SAnirudh Venkataramanan }
4280ebd3ff1SAnirudh Venkataramanan
4290ebd3ff1SAnirudh Venkataramanan /**
4300ebd3ff1SAnirudh Venkataramanan * ice_parse_cee_pfccfg_tlv
4310ebd3ff1SAnirudh Venkataramanan * @tlv: CEE DCBX PFC CFG TLV
4320ebd3ff1SAnirudh Venkataramanan * @dcbcfg: Local store to update PFC CFG data
4330ebd3ff1SAnirudh Venkataramanan *
4340ebd3ff1SAnirudh Venkataramanan * Parses CEE DCBX PFC CFG TLV
4350ebd3ff1SAnirudh Venkataramanan */
4360ebd3ff1SAnirudh Venkataramanan static void
ice_parse_cee_pfccfg_tlv(struct ice_cee_feat_tlv * tlv,struct ice_dcbx_cfg * dcbcfg)4370ebd3ff1SAnirudh Venkataramanan ice_parse_cee_pfccfg_tlv(struct ice_cee_feat_tlv *tlv,
4380ebd3ff1SAnirudh Venkataramanan struct ice_dcbx_cfg *dcbcfg)
4390ebd3ff1SAnirudh Venkataramanan {
4400ebd3ff1SAnirudh Venkataramanan u8 *buf = tlv->tlvinfo;
4410ebd3ff1SAnirudh Venkataramanan
4420ebd3ff1SAnirudh Venkataramanan if (tlv->en_will_err & ICE_CEE_FEAT_TLV_WILLING_M)
4430ebd3ff1SAnirudh Venkataramanan dcbcfg->pfc.willing = 1;
4440ebd3ff1SAnirudh Venkataramanan
4450ebd3ff1SAnirudh Venkataramanan /* ------------------------
4460ebd3ff1SAnirudh Venkataramanan * | PFC Enable | PFC TCs |
4470ebd3ff1SAnirudh Venkataramanan * ------------------------
4480ebd3ff1SAnirudh Venkataramanan * | 1 octet | 1 octet |
4490ebd3ff1SAnirudh Venkataramanan */
4500ebd3ff1SAnirudh Venkataramanan dcbcfg->pfc.pfcena = buf[0];
4510ebd3ff1SAnirudh Venkataramanan dcbcfg->pfc.pfccap = buf[1];
4520ebd3ff1SAnirudh Venkataramanan }
4530ebd3ff1SAnirudh Venkataramanan
4540ebd3ff1SAnirudh Venkataramanan /**
4550ebd3ff1SAnirudh Venkataramanan * ice_parse_cee_app_tlv
4560ebd3ff1SAnirudh Venkataramanan * @tlv: CEE DCBX APP TLV
4570ebd3ff1SAnirudh Venkataramanan * @dcbcfg: Local store to update APP PRIO data
4580ebd3ff1SAnirudh Venkataramanan *
4590ebd3ff1SAnirudh Venkataramanan * Parses CEE DCBX APP PRIO TLV
4600ebd3ff1SAnirudh Venkataramanan */
4610ebd3ff1SAnirudh Venkataramanan static void
ice_parse_cee_app_tlv(struct ice_cee_feat_tlv * tlv,struct ice_dcbx_cfg * dcbcfg)4620ebd3ff1SAnirudh Venkataramanan ice_parse_cee_app_tlv(struct ice_cee_feat_tlv *tlv, struct ice_dcbx_cfg *dcbcfg)
4630ebd3ff1SAnirudh Venkataramanan {
4640ebd3ff1SAnirudh Venkataramanan u16 len, typelen, offset = 0;
4650ebd3ff1SAnirudh Venkataramanan struct ice_cee_app_prio *app;
4660ebd3ff1SAnirudh Venkataramanan u8 i;
4670ebd3ff1SAnirudh Venkataramanan
4680ebd3ff1SAnirudh Venkataramanan typelen = ntohs(tlv->hdr.typelen);
4690ebd3ff1SAnirudh Venkataramanan len = ((typelen & ICE_LLDP_TLV_LEN_M) >> ICE_LLDP_TLV_LEN_S);
4700ebd3ff1SAnirudh Venkataramanan
4710ebd3ff1SAnirudh Venkataramanan dcbcfg->numapps = len / sizeof(*app);
4720ebd3ff1SAnirudh Venkataramanan if (!dcbcfg->numapps)
4730ebd3ff1SAnirudh Venkataramanan return;
4740ebd3ff1SAnirudh Venkataramanan if (dcbcfg->numapps > ICE_DCBX_MAX_APPS)
4750ebd3ff1SAnirudh Venkataramanan dcbcfg->numapps = ICE_DCBX_MAX_APPS;
4760ebd3ff1SAnirudh Venkataramanan
4770ebd3ff1SAnirudh Venkataramanan for (i = 0; i < dcbcfg->numapps; i++) {
4780ebd3ff1SAnirudh Venkataramanan u8 up, selector;
4790ebd3ff1SAnirudh Venkataramanan
4800ebd3ff1SAnirudh Venkataramanan app = (struct ice_cee_app_prio *)(tlv->tlvinfo + offset);
4810ebd3ff1SAnirudh Venkataramanan for (up = 0; up < ICE_MAX_USER_PRIORITY; up++)
4820ebd3ff1SAnirudh Venkataramanan if (app->prio_map & BIT(up))
4830ebd3ff1SAnirudh Venkataramanan break;
4840ebd3ff1SAnirudh Venkataramanan
4850ebd3ff1SAnirudh Venkataramanan dcbcfg->app[i].priority = up;
4860ebd3ff1SAnirudh Venkataramanan
4870ebd3ff1SAnirudh Venkataramanan /* Get Selector from lower 2 bits, and convert to IEEE */
4880ebd3ff1SAnirudh Venkataramanan selector = (app->upper_oui_sel & ICE_CEE_APP_SELECTOR_M);
4890ebd3ff1SAnirudh Venkataramanan switch (selector) {
4900ebd3ff1SAnirudh Venkataramanan case ICE_CEE_APP_SEL_ETHTYPE:
4910ebd3ff1SAnirudh Venkataramanan dcbcfg->app[i].selector = ICE_APP_SEL_ETHTYPE;
4920ebd3ff1SAnirudh Venkataramanan break;
4930ebd3ff1SAnirudh Venkataramanan case ICE_CEE_APP_SEL_TCPIP:
4940ebd3ff1SAnirudh Venkataramanan dcbcfg->app[i].selector = ICE_APP_SEL_TCPIP;
4950ebd3ff1SAnirudh Venkataramanan break;
4960ebd3ff1SAnirudh Venkataramanan default:
4970ebd3ff1SAnirudh Venkataramanan /* Keep selector as it is for unknown types */
4980ebd3ff1SAnirudh Venkataramanan dcbcfg->app[i].selector = selector;
4990ebd3ff1SAnirudh Venkataramanan }
5000ebd3ff1SAnirudh Venkataramanan
5010ebd3ff1SAnirudh Venkataramanan dcbcfg->app[i].prot_id = ntohs(app->protocol);
5020ebd3ff1SAnirudh Venkataramanan /* Move to next app */
5030ebd3ff1SAnirudh Venkataramanan offset += sizeof(*app);
5040ebd3ff1SAnirudh Venkataramanan }
5050ebd3ff1SAnirudh Venkataramanan }
5060ebd3ff1SAnirudh Venkataramanan
5070ebd3ff1SAnirudh Venkataramanan /**
5080ebd3ff1SAnirudh Venkataramanan * ice_parse_cee_tlv
5090ebd3ff1SAnirudh Venkataramanan * @tlv: CEE DCBX TLV
5100ebd3ff1SAnirudh Venkataramanan * @dcbcfg: Local store to update DCBX config data
5110ebd3ff1SAnirudh Venkataramanan *
5120ebd3ff1SAnirudh Venkataramanan * Get the TLV subtype and send it to parsing function
5130ebd3ff1SAnirudh Venkataramanan * based on the subtype value
5140ebd3ff1SAnirudh Venkataramanan */
5150ebd3ff1SAnirudh Venkataramanan static void
ice_parse_cee_tlv(struct ice_lldp_org_tlv * tlv,struct ice_dcbx_cfg * dcbcfg)5160ebd3ff1SAnirudh Venkataramanan ice_parse_cee_tlv(struct ice_lldp_org_tlv *tlv, struct ice_dcbx_cfg *dcbcfg)
5170ebd3ff1SAnirudh Venkataramanan {
5180ebd3ff1SAnirudh Venkataramanan struct ice_cee_feat_tlv *sub_tlv;
5190ebd3ff1SAnirudh Venkataramanan u8 subtype, feat_tlv_count = 0;
5200ebd3ff1SAnirudh Venkataramanan u16 len, tlvlen, typelen;
5210ebd3ff1SAnirudh Venkataramanan u32 ouisubtype;
5220ebd3ff1SAnirudh Venkataramanan
5230ebd3ff1SAnirudh Venkataramanan ouisubtype = ntohl(tlv->ouisubtype);
5240ebd3ff1SAnirudh Venkataramanan subtype = (u8)((ouisubtype & ICE_LLDP_TLV_SUBTYPE_M) >>
5250ebd3ff1SAnirudh Venkataramanan ICE_LLDP_TLV_SUBTYPE_S);
5260ebd3ff1SAnirudh Venkataramanan /* Return if not CEE DCBX */
5270ebd3ff1SAnirudh Venkataramanan if (subtype != ICE_CEE_DCBX_TYPE)
5280ebd3ff1SAnirudh Venkataramanan return;
5290ebd3ff1SAnirudh Venkataramanan
5300ebd3ff1SAnirudh Venkataramanan typelen = ntohs(tlv->typelen);
5310ebd3ff1SAnirudh Venkataramanan tlvlen = ((typelen & ICE_LLDP_TLV_LEN_M) >> ICE_LLDP_TLV_LEN_S);
5320ebd3ff1SAnirudh Venkataramanan len = sizeof(tlv->typelen) + sizeof(ouisubtype) +
5330ebd3ff1SAnirudh Venkataramanan sizeof(struct ice_cee_ctrl_tlv);
5340ebd3ff1SAnirudh Venkataramanan /* Return if no CEE DCBX Feature TLVs */
5350ebd3ff1SAnirudh Venkataramanan if (tlvlen <= len)
5360ebd3ff1SAnirudh Venkataramanan return;
5370ebd3ff1SAnirudh Venkataramanan
5380ebd3ff1SAnirudh Venkataramanan sub_tlv = (struct ice_cee_feat_tlv *)((char *)tlv + len);
5390ebd3ff1SAnirudh Venkataramanan while (feat_tlv_count < ICE_CEE_MAX_FEAT_TYPE) {
5400ebd3ff1SAnirudh Venkataramanan u16 sublen;
5410ebd3ff1SAnirudh Venkataramanan
5420ebd3ff1SAnirudh Venkataramanan typelen = ntohs(sub_tlv->hdr.typelen);
5430ebd3ff1SAnirudh Venkataramanan sublen = ((typelen & ICE_LLDP_TLV_LEN_M) >> ICE_LLDP_TLV_LEN_S);
5440ebd3ff1SAnirudh Venkataramanan subtype = (u8)((typelen & ICE_LLDP_TLV_TYPE_M) >>
5450ebd3ff1SAnirudh Venkataramanan ICE_LLDP_TLV_TYPE_S);
5460ebd3ff1SAnirudh Venkataramanan switch (subtype) {
5470ebd3ff1SAnirudh Venkataramanan case ICE_CEE_SUBTYPE_PG_CFG:
5480ebd3ff1SAnirudh Venkataramanan ice_parse_cee_pgcfg_tlv(sub_tlv, dcbcfg);
5490ebd3ff1SAnirudh Venkataramanan break;
5500ebd3ff1SAnirudh Venkataramanan case ICE_CEE_SUBTYPE_PFC_CFG:
5510ebd3ff1SAnirudh Venkataramanan ice_parse_cee_pfccfg_tlv(sub_tlv, dcbcfg);
5520ebd3ff1SAnirudh Venkataramanan break;
5530ebd3ff1SAnirudh Venkataramanan case ICE_CEE_SUBTYPE_APP_PRI:
5540ebd3ff1SAnirudh Venkataramanan ice_parse_cee_app_tlv(sub_tlv, dcbcfg);
5550ebd3ff1SAnirudh Venkataramanan break;
5560ebd3ff1SAnirudh Venkataramanan default:
5570ebd3ff1SAnirudh Venkataramanan return; /* Invalid Sub-type return */
5580ebd3ff1SAnirudh Venkataramanan }
5590ebd3ff1SAnirudh Venkataramanan feat_tlv_count++;
5600ebd3ff1SAnirudh Venkataramanan /* Move to next sub TLV */
5610ebd3ff1SAnirudh Venkataramanan sub_tlv = (struct ice_cee_feat_tlv *)
5620ebd3ff1SAnirudh Venkataramanan ((char *)sub_tlv + sizeof(sub_tlv->hdr.typelen) +
5630ebd3ff1SAnirudh Venkataramanan sublen);
5640ebd3ff1SAnirudh Venkataramanan }
5650ebd3ff1SAnirudh Venkataramanan }
5660ebd3ff1SAnirudh Venkataramanan
5670ebd3ff1SAnirudh Venkataramanan /**
5680ebd3ff1SAnirudh Venkataramanan * ice_parse_org_tlv
5690ebd3ff1SAnirudh Venkataramanan * @tlv: Organization specific TLV
5700ebd3ff1SAnirudh Venkataramanan * @dcbcfg: Local store to update ETS REC data
5710ebd3ff1SAnirudh Venkataramanan *
57213b599f1SZhu Yanjun * Currently IEEE 802.1Qaz and CEE DCBX TLV are supported, others
5730ebd3ff1SAnirudh Venkataramanan * will be returned
5740ebd3ff1SAnirudh Venkataramanan */
5750ebd3ff1SAnirudh Venkataramanan static void
ice_parse_org_tlv(struct ice_lldp_org_tlv * tlv,struct ice_dcbx_cfg * dcbcfg)5760ebd3ff1SAnirudh Venkataramanan ice_parse_org_tlv(struct ice_lldp_org_tlv *tlv, struct ice_dcbx_cfg *dcbcfg)
5770ebd3ff1SAnirudh Venkataramanan {
5780ebd3ff1SAnirudh Venkataramanan u32 ouisubtype;
5790ebd3ff1SAnirudh Venkataramanan u32 oui;
5800ebd3ff1SAnirudh Venkataramanan
5810ebd3ff1SAnirudh Venkataramanan ouisubtype = ntohl(tlv->ouisubtype);
5820ebd3ff1SAnirudh Venkataramanan oui = ((ouisubtype & ICE_LLDP_TLV_OUI_M) >> ICE_LLDP_TLV_OUI_S);
5830ebd3ff1SAnirudh Venkataramanan switch (oui) {
5840ebd3ff1SAnirudh Venkataramanan case ICE_IEEE_8021QAZ_OUI:
5850ebd3ff1SAnirudh Venkataramanan ice_parse_ieee_tlv(tlv, dcbcfg);
5860ebd3ff1SAnirudh Venkataramanan break;
5870ebd3ff1SAnirudh Venkataramanan case ICE_CEE_DCBX_OUI:
5880ebd3ff1SAnirudh Venkataramanan ice_parse_cee_tlv(tlv, dcbcfg);
5890ebd3ff1SAnirudh Venkataramanan break;
5900ebd3ff1SAnirudh Venkataramanan default:
59113b599f1SZhu Yanjun break; /* Other OUIs not supported */
5920ebd3ff1SAnirudh Venkataramanan }
5930ebd3ff1SAnirudh Venkataramanan }
5940ebd3ff1SAnirudh Venkataramanan
5950ebd3ff1SAnirudh Venkataramanan /**
5960ebd3ff1SAnirudh Venkataramanan * ice_lldp_to_dcb_cfg
5970ebd3ff1SAnirudh Venkataramanan * @lldpmib: LLDPDU to be parsed
5980ebd3ff1SAnirudh Venkataramanan * @dcbcfg: store for LLDPDU data
5990ebd3ff1SAnirudh Venkataramanan *
6000ebd3ff1SAnirudh Venkataramanan * Parse DCB configuration from the LLDPDU
6010ebd3ff1SAnirudh Venkataramanan */
ice_lldp_to_dcb_cfg(u8 * lldpmib,struct ice_dcbx_cfg * dcbcfg)6025518ac2aSTony Nguyen static int ice_lldp_to_dcb_cfg(u8 *lldpmib, struct ice_dcbx_cfg *dcbcfg)
6030ebd3ff1SAnirudh Venkataramanan {
6040ebd3ff1SAnirudh Venkataramanan struct ice_lldp_org_tlv *tlv;
6050ebd3ff1SAnirudh Venkataramanan u16 offset = 0;
6065518ac2aSTony Nguyen int ret = 0;
6070ebd3ff1SAnirudh Venkataramanan u16 typelen;
6080ebd3ff1SAnirudh Venkataramanan u16 type;
6090ebd3ff1SAnirudh Venkataramanan u16 len;
6100ebd3ff1SAnirudh Venkataramanan
6110ebd3ff1SAnirudh Venkataramanan if (!lldpmib || !dcbcfg)
612d54699e2STony Nguyen return -EINVAL;
6130ebd3ff1SAnirudh Venkataramanan
6140ebd3ff1SAnirudh Venkataramanan /* set to the start of LLDPDU */
6150ebd3ff1SAnirudh Venkataramanan lldpmib += ETH_HLEN;
6160ebd3ff1SAnirudh Venkataramanan tlv = (struct ice_lldp_org_tlv *)lldpmib;
6170ebd3ff1SAnirudh Venkataramanan while (1) {
6180ebd3ff1SAnirudh Venkataramanan typelen = ntohs(tlv->typelen);
6190ebd3ff1SAnirudh Venkataramanan type = ((typelen & ICE_LLDP_TLV_TYPE_M) >> ICE_LLDP_TLV_TYPE_S);
6200ebd3ff1SAnirudh Venkataramanan len = ((typelen & ICE_LLDP_TLV_LEN_M) >> ICE_LLDP_TLV_LEN_S);
6210ebd3ff1SAnirudh Venkataramanan offset += sizeof(typelen) + len;
6220ebd3ff1SAnirudh Venkataramanan
6230ebd3ff1SAnirudh Venkataramanan /* END TLV or beyond LLDPDU size */
6240ebd3ff1SAnirudh Venkataramanan if (type == ICE_TLV_TYPE_END || offset > ICE_LLDPDU_SIZE)
6250ebd3ff1SAnirudh Venkataramanan break;
6260ebd3ff1SAnirudh Venkataramanan
6270ebd3ff1SAnirudh Venkataramanan switch (type) {
6280ebd3ff1SAnirudh Venkataramanan case ICE_TLV_TYPE_ORG:
6290ebd3ff1SAnirudh Venkataramanan ice_parse_org_tlv(tlv, dcbcfg);
6300ebd3ff1SAnirudh Venkataramanan break;
6310ebd3ff1SAnirudh Venkataramanan default:
6320ebd3ff1SAnirudh Venkataramanan break;
6330ebd3ff1SAnirudh Venkataramanan }
6340ebd3ff1SAnirudh Venkataramanan
6350ebd3ff1SAnirudh Venkataramanan /* Move to next TLV */
6360ebd3ff1SAnirudh Venkataramanan tlv = (struct ice_lldp_org_tlv *)
6370ebd3ff1SAnirudh Venkataramanan ((char *)tlv + sizeof(tlv->typelen) + len);
6380ebd3ff1SAnirudh Venkataramanan }
6390ebd3ff1SAnirudh Venkataramanan
6400ebd3ff1SAnirudh Venkataramanan return ret;
6410ebd3ff1SAnirudh Venkataramanan }
6420ebd3ff1SAnirudh Venkataramanan
6430ebd3ff1SAnirudh Venkataramanan /**
6440ebd3ff1SAnirudh Venkataramanan * ice_aq_get_dcb_cfg
6450ebd3ff1SAnirudh Venkataramanan * @hw: pointer to the HW struct
6462f2da36eSAnirudh Venkataramanan * @mib_type: MIB type for the query
6470ebd3ff1SAnirudh Venkataramanan * @bridgetype: bridge type for the query (remote)
6480ebd3ff1SAnirudh Venkataramanan * @dcbcfg: store for LLDPDU data
6490ebd3ff1SAnirudh Venkataramanan *
6500ebd3ff1SAnirudh Venkataramanan * Query DCB configuration from the firmware
6510ebd3ff1SAnirudh Venkataramanan */
6525e24d598STony Nguyen int
ice_aq_get_dcb_cfg(struct ice_hw * hw,u8 mib_type,u8 bridgetype,struct ice_dcbx_cfg * dcbcfg)6530ebd3ff1SAnirudh Venkataramanan ice_aq_get_dcb_cfg(struct ice_hw *hw, u8 mib_type, u8 bridgetype,
6540ebd3ff1SAnirudh Venkataramanan struct ice_dcbx_cfg *dcbcfg)
6550ebd3ff1SAnirudh Venkataramanan {
6560ebd3ff1SAnirudh Venkataramanan u8 *lldpmib;
6575518ac2aSTony Nguyen int ret;
6580ebd3ff1SAnirudh Venkataramanan
6590ebd3ff1SAnirudh Venkataramanan /* Allocate the LLDPDU */
6600ebd3ff1SAnirudh Venkataramanan lldpmib = devm_kzalloc(ice_hw_to_dev(hw), ICE_LLDPDU_SIZE, GFP_KERNEL);
6610ebd3ff1SAnirudh Venkataramanan if (!lldpmib)
662d54699e2STony Nguyen return -ENOMEM;
6630ebd3ff1SAnirudh Venkataramanan
6640ebd3ff1SAnirudh Venkataramanan ret = ice_aq_get_lldp_mib(hw, bridgetype, mib_type, (void *)lldpmib,
6650ebd3ff1SAnirudh Venkataramanan ICE_LLDPDU_SIZE, NULL, NULL, NULL);
6660ebd3ff1SAnirudh Venkataramanan
6670ebd3ff1SAnirudh Venkataramanan if (!ret)
6680ebd3ff1SAnirudh Venkataramanan /* Parse LLDP MIB to get DCB configuration */
6690ebd3ff1SAnirudh Venkataramanan ret = ice_lldp_to_dcb_cfg(lldpmib, dcbcfg);
6700ebd3ff1SAnirudh Venkataramanan
6710ebd3ff1SAnirudh Venkataramanan devm_kfree(ice_hw_to_dev(hw), lldpmib);
6720ebd3ff1SAnirudh Venkataramanan
6730ebd3ff1SAnirudh Venkataramanan return ret;
6740ebd3ff1SAnirudh Venkataramanan }
6750ebd3ff1SAnirudh Venkataramanan
6760ebd3ff1SAnirudh Venkataramanan /**
6772f2da36eSAnirudh Venkataramanan * ice_aq_start_stop_dcbx - Start/Stop DCBX service in FW
67837b6f646SAnirudh Venkataramanan * @hw: pointer to the HW struct
6792f2da36eSAnirudh Venkataramanan * @start_dcbx_agent: True if DCBX Agent needs to be started
6802f2da36eSAnirudh Venkataramanan * False if DCBX Agent needs to be stopped
6812f2da36eSAnirudh Venkataramanan * @dcbx_agent_status: FW indicates back the DCBX agent status
6822f2da36eSAnirudh Venkataramanan * True if DCBX Agent is active
6832f2da36eSAnirudh Venkataramanan * False if DCBX Agent is stopped
68437b6f646SAnirudh Venkataramanan * @cd: pointer to command details structure or NULL
68537b6f646SAnirudh Venkataramanan *
68637b6f646SAnirudh Venkataramanan * Start/Stop the embedded dcbx Agent. In case that this wrapper function
687d54699e2STony Nguyen * returns 0, caller will need to check if FW returns back the same
68837b6f646SAnirudh Venkataramanan * value as stated in dcbx_agent_status, and react accordingly. (0x0A09)
68937b6f646SAnirudh Venkataramanan */
6905e24d598STony Nguyen int
ice_aq_start_stop_dcbx(struct ice_hw * hw,bool start_dcbx_agent,bool * dcbx_agent_status,struct ice_sq_cd * cd)69137b6f646SAnirudh Venkataramanan ice_aq_start_stop_dcbx(struct ice_hw *hw, bool start_dcbx_agent,
69237b6f646SAnirudh Venkataramanan bool *dcbx_agent_status, struct ice_sq_cd *cd)
69337b6f646SAnirudh Venkataramanan {
69437b6f646SAnirudh Venkataramanan struct ice_aqc_lldp_stop_start_specific_agent *cmd;
69537b6f646SAnirudh Venkataramanan struct ice_aq_desc desc;
69637b6f646SAnirudh Venkataramanan u16 opcode;
6975518ac2aSTony Nguyen int status;
69837b6f646SAnirudh Venkataramanan
69937b6f646SAnirudh Venkataramanan cmd = &desc.params.lldp_agent_ctrl;
70037b6f646SAnirudh Venkataramanan
70137b6f646SAnirudh Venkataramanan opcode = ice_aqc_opc_lldp_stop_start_specific_agent;
70237b6f646SAnirudh Venkataramanan
70337b6f646SAnirudh Venkataramanan ice_fill_dflt_direct_cmd_desc(&desc, opcode);
70437b6f646SAnirudh Venkataramanan
70537b6f646SAnirudh Venkataramanan if (start_dcbx_agent)
70637b6f646SAnirudh Venkataramanan cmd->command = ICE_AQC_START_STOP_AGENT_START_DCBX;
70737b6f646SAnirudh Venkataramanan
70837b6f646SAnirudh Venkataramanan status = ice_aq_send_cmd(hw, &desc, NULL, 0, cd);
70937b6f646SAnirudh Venkataramanan
71037b6f646SAnirudh Venkataramanan *dcbx_agent_status = false;
71137b6f646SAnirudh Venkataramanan
71237b6f646SAnirudh Venkataramanan if (!status &&
71337b6f646SAnirudh Venkataramanan cmd->command == ICE_AQC_START_STOP_AGENT_START_DCBX)
71437b6f646SAnirudh Venkataramanan *dcbx_agent_status = true;
71537b6f646SAnirudh Venkataramanan
71637b6f646SAnirudh Venkataramanan return status;
71737b6f646SAnirudh Venkataramanan }
7180ebd3ff1SAnirudh Venkataramanan
7190ebd3ff1SAnirudh Venkataramanan /**
7200ebd3ff1SAnirudh Venkataramanan * ice_aq_get_cee_dcb_cfg
7210ebd3ff1SAnirudh Venkataramanan * @hw: pointer to the HW struct
7220ebd3ff1SAnirudh Venkataramanan * @buff: response buffer that stores CEE operational configuration
7230ebd3ff1SAnirudh Venkataramanan * @cd: pointer to command details structure or NULL
7240ebd3ff1SAnirudh Venkataramanan *
7250ebd3ff1SAnirudh Venkataramanan * Get CEE DCBX mode operational configuration from firmware (0x0A07)
7260ebd3ff1SAnirudh Venkataramanan */
7275e24d598STony Nguyen static int
ice_aq_get_cee_dcb_cfg(struct ice_hw * hw,struct ice_aqc_get_cee_dcb_cfg_resp * buff,struct ice_sq_cd * cd)7280ebd3ff1SAnirudh Venkataramanan ice_aq_get_cee_dcb_cfg(struct ice_hw *hw,
7290ebd3ff1SAnirudh Venkataramanan struct ice_aqc_get_cee_dcb_cfg_resp *buff,
7300ebd3ff1SAnirudh Venkataramanan struct ice_sq_cd *cd)
7310ebd3ff1SAnirudh Venkataramanan {
7320ebd3ff1SAnirudh Venkataramanan struct ice_aq_desc desc;
7330ebd3ff1SAnirudh Venkataramanan
7340ebd3ff1SAnirudh Venkataramanan ice_fill_dflt_direct_cmd_desc(&desc, ice_aqc_opc_get_cee_dcb_cfg);
7350ebd3ff1SAnirudh Venkataramanan
7360ebd3ff1SAnirudh Venkataramanan return ice_aq_send_cmd(hw, &desc, (void *)buff, sizeof(*buff), cd);
7370ebd3ff1SAnirudh Venkataramanan }
7380ebd3ff1SAnirudh Venkataramanan
7390ebd3ff1SAnirudh Venkataramanan /**
7402a87bd73SDave Ertman * ice_aq_set_pfc_mode - Set PFC mode
7412a87bd73SDave Ertman * @hw: pointer to the HW struct
7422a87bd73SDave Ertman * @pfc_mode: value of PFC mode to set
7432a87bd73SDave Ertman * @cd: pointer to command details structure or NULL
7442a87bd73SDave Ertman *
7452a87bd73SDave Ertman * This AQ call configures the PFC mode to DSCP-based PFC mode or
7462a87bd73SDave Ertman * VLAN-based PFC (0x0303)
7472a87bd73SDave Ertman */
ice_aq_set_pfc_mode(struct ice_hw * hw,u8 pfc_mode,struct ice_sq_cd * cd)7482a87bd73SDave Ertman int ice_aq_set_pfc_mode(struct ice_hw *hw, u8 pfc_mode, struct ice_sq_cd *cd)
7492a87bd73SDave Ertman {
7502a87bd73SDave Ertman struct ice_aqc_set_query_pfc_mode *cmd;
7512a87bd73SDave Ertman struct ice_aq_desc desc;
7525e24d598STony Nguyen int status;
7532a87bd73SDave Ertman
7542a87bd73SDave Ertman if (pfc_mode > ICE_AQC_PFC_DSCP_BASED_PFC)
7552a87bd73SDave Ertman return -EINVAL;
7562a87bd73SDave Ertman
7572a87bd73SDave Ertman cmd = &desc.params.set_query_pfc_mode;
7582a87bd73SDave Ertman
7592a87bd73SDave Ertman ice_fill_dflt_direct_cmd_desc(&desc, ice_aqc_opc_set_pfc_mode);
7602a87bd73SDave Ertman
7612a87bd73SDave Ertman cmd->pfc_mode = pfc_mode;
7622a87bd73SDave Ertman
7632a87bd73SDave Ertman status = ice_aq_send_cmd(hw, &desc, NULL, 0, cd);
7642a87bd73SDave Ertman if (status)
765d54699e2STony Nguyen return status;
7662a87bd73SDave Ertman
7672a87bd73SDave Ertman /* FW will write the PFC mode set back into cmd->pfc_mode, but if DCB is
7682a87bd73SDave Ertman * disabled, FW will write back 0 to cmd->pfc_mode. After the AQ has
7692a87bd73SDave Ertman * been executed, check if cmd->pfc_mode is what was requested. If not,
7702a87bd73SDave Ertman * return an error.
7712a87bd73SDave Ertman */
7722a87bd73SDave Ertman if (cmd->pfc_mode != pfc_mode)
7732a87bd73SDave Ertman return -EOPNOTSUPP;
7742a87bd73SDave Ertman
7752a87bd73SDave Ertman return 0;
7762a87bd73SDave Ertman }
7772a87bd73SDave Ertman
7782a87bd73SDave Ertman /**
7790ebd3ff1SAnirudh Venkataramanan * ice_cee_to_dcb_cfg
7800ebd3ff1SAnirudh Venkataramanan * @cee_cfg: pointer to CEE configuration struct
781aeac8ce8SChinh T Cao * @pi: port information structure
7820ebd3ff1SAnirudh Venkataramanan *
7830ebd3ff1SAnirudh Venkataramanan * Convert CEE configuration from firmware to DCB configuration
7840ebd3ff1SAnirudh Venkataramanan */
7850ebd3ff1SAnirudh Venkataramanan static void
ice_cee_to_dcb_cfg(struct ice_aqc_get_cee_dcb_cfg_resp * cee_cfg,struct ice_port_info * pi)7860ebd3ff1SAnirudh Venkataramanan ice_cee_to_dcb_cfg(struct ice_aqc_get_cee_dcb_cfg_resp *cee_cfg,
787aeac8ce8SChinh T Cao struct ice_port_info *pi)
7880ebd3ff1SAnirudh Venkataramanan {
7890ebd3ff1SAnirudh Venkataramanan u32 status, tlv_status = le32_to_cpu(cee_cfg->tlv_status);
790ef963ae4SColin Ian King u32 ice_aqc_cee_status_mask, ice_aqc_cee_status_shift, j;
791ef963ae4SColin Ian King u8 i, err, sync, oper, app_index, ice_app_sel_type;
7920ebd3ff1SAnirudh Venkataramanan u16 app_prio = le16_to_cpu(cee_cfg->oper_app_prio);
7930ebd3ff1SAnirudh Venkataramanan u16 ice_aqc_cee_app_mask, ice_aqc_cee_app_shift;
794aeac8ce8SChinh T Cao struct ice_dcbx_cfg *cmp_dcbcfg, *dcbcfg;
7950ebd3ff1SAnirudh Venkataramanan u16 ice_app_prot_id_type;
7960ebd3ff1SAnirudh Venkataramanan
797aeac8ce8SChinh T Cao dcbcfg = &pi->qos_cfg.local_dcbx_cfg;
798aeac8ce8SChinh T Cao dcbcfg->dcbx_mode = ICE_DCBX_MODE_CEE;
799aeac8ce8SChinh T Cao dcbcfg->tlv_status = tlv_status;
800aeac8ce8SChinh T Cao
801aeac8ce8SChinh T Cao /* CEE PG data */
8020ebd3ff1SAnirudh Venkataramanan dcbcfg->etscfg.maxtcs = cee_cfg->oper_num_tc;
8030ebd3ff1SAnirudh Venkataramanan
8040ebd3ff1SAnirudh Venkataramanan /* Note that the FW creates the oper_prio_tc nibbles reversed
8050ebd3ff1SAnirudh Venkataramanan * from those in the CEE Priority Group sub-TLV.
8060ebd3ff1SAnirudh Venkataramanan */
8070ebd3ff1SAnirudh Venkataramanan for (i = 0; i < ICE_MAX_TRAFFIC_CLASS / 2; i++) {
8080ebd3ff1SAnirudh Venkataramanan dcbcfg->etscfg.prio_table[i * 2] =
8090ebd3ff1SAnirudh Venkataramanan ((cee_cfg->oper_prio_tc[i] & ICE_CEE_PGID_PRIO_0_M) >>
8100ebd3ff1SAnirudh Venkataramanan ICE_CEE_PGID_PRIO_0_S);
8110ebd3ff1SAnirudh Venkataramanan dcbcfg->etscfg.prio_table[i * 2 + 1] =
8120ebd3ff1SAnirudh Venkataramanan ((cee_cfg->oper_prio_tc[i] & ICE_CEE_PGID_PRIO_1_M) >>
8130ebd3ff1SAnirudh Venkataramanan ICE_CEE_PGID_PRIO_1_S);
8140ebd3ff1SAnirudh Venkataramanan }
8150ebd3ff1SAnirudh Venkataramanan
8160ebd3ff1SAnirudh Venkataramanan ice_for_each_traffic_class(i) {
8170ebd3ff1SAnirudh Venkataramanan dcbcfg->etscfg.tcbwtable[i] = cee_cfg->oper_tc_bw[i];
8180ebd3ff1SAnirudh Venkataramanan
8190ebd3ff1SAnirudh Venkataramanan if (dcbcfg->etscfg.prio_table[i] == ICE_CEE_PGID_STRICT) {
8200ebd3ff1SAnirudh Venkataramanan /* Map it to next empty TC */
8210ebd3ff1SAnirudh Venkataramanan dcbcfg->etscfg.prio_table[i] = cee_cfg->oper_num_tc - 1;
8220ebd3ff1SAnirudh Venkataramanan dcbcfg->etscfg.tsatable[i] = ICE_IEEE_TSA_STRICT;
8230ebd3ff1SAnirudh Venkataramanan } else {
8240ebd3ff1SAnirudh Venkataramanan dcbcfg->etscfg.tsatable[i] = ICE_IEEE_TSA_ETS;
8250ebd3ff1SAnirudh Venkataramanan }
8260ebd3ff1SAnirudh Venkataramanan }
8270ebd3ff1SAnirudh Venkataramanan
828aeac8ce8SChinh T Cao /* CEE PFC data */
8290ebd3ff1SAnirudh Venkataramanan dcbcfg->pfc.pfcena = cee_cfg->oper_pfc_en;
8300ebd3ff1SAnirudh Venkataramanan dcbcfg->pfc.pfccap = ICE_MAX_TRAFFIC_CLASS;
8310ebd3ff1SAnirudh Venkataramanan
832aeac8ce8SChinh T Cao /* CEE APP TLV data */
833aeac8ce8SChinh T Cao if (dcbcfg->app_mode == ICE_DCBX_APPS_NON_WILLING)
834aeac8ce8SChinh T Cao cmp_dcbcfg = &pi->qos_cfg.desired_dcbx_cfg;
835aeac8ce8SChinh T Cao else
836aeac8ce8SChinh T Cao cmp_dcbcfg = &pi->qos_cfg.remote_dcbx_cfg;
837aeac8ce8SChinh T Cao
8380ebd3ff1SAnirudh Venkataramanan app_index = 0;
8390ebd3ff1SAnirudh Venkataramanan for (i = 0; i < 3; i++) {
8400ebd3ff1SAnirudh Venkataramanan if (i == 0) {
8410ebd3ff1SAnirudh Venkataramanan /* FCoE APP */
8420ebd3ff1SAnirudh Venkataramanan ice_aqc_cee_status_mask = ICE_AQC_CEE_FCOE_STATUS_M;
8430ebd3ff1SAnirudh Venkataramanan ice_aqc_cee_status_shift = ICE_AQC_CEE_FCOE_STATUS_S;
8440ebd3ff1SAnirudh Venkataramanan ice_aqc_cee_app_mask = ICE_AQC_CEE_APP_FCOE_M;
8450ebd3ff1SAnirudh Venkataramanan ice_aqc_cee_app_shift = ICE_AQC_CEE_APP_FCOE_S;
8460ebd3ff1SAnirudh Venkataramanan ice_app_sel_type = ICE_APP_SEL_ETHTYPE;
847d41f26b5SBruce Allan ice_app_prot_id_type = ETH_P_FCOE;
8480ebd3ff1SAnirudh Venkataramanan } else if (i == 1) {
8490ebd3ff1SAnirudh Venkataramanan /* iSCSI APP */
8500ebd3ff1SAnirudh Venkataramanan ice_aqc_cee_status_mask = ICE_AQC_CEE_ISCSI_STATUS_M;
8510ebd3ff1SAnirudh Venkataramanan ice_aqc_cee_status_shift = ICE_AQC_CEE_ISCSI_STATUS_S;
8520ebd3ff1SAnirudh Venkataramanan ice_aqc_cee_app_mask = ICE_AQC_CEE_APP_ISCSI_M;
8530ebd3ff1SAnirudh Venkataramanan ice_aqc_cee_app_shift = ICE_AQC_CEE_APP_ISCSI_S;
8540ebd3ff1SAnirudh Venkataramanan ice_app_sel_type = ICE_APP_SEL_TCPIP;
855d41f26b5SBruce Allan ice_app_prot_id_type = ISCSI_LISTEN_PORT;
856aeac8ce8SChinh T Cao
857aeac8ce8SChinh T Cao for (j = 0; j < cmp_dcbcfg->numapps; j++) {
858aeac8ce8SChinh T Cao u16 prot_id = cmp_dcbcfg->app[j].prot_id;
859aeac8ce8SChinh T Cao u8 sel = cmp_dcbcfg->app[j].selector;
860aeac8ce8SChinh T Cao
861aeac8ce8SChinh T Cao if (sel == ICE_APP_SEL_TCPIP &&
862d41f26b5SBruce Allan (prot_id == ISCSI_LISTEN_PORT ||
863aeac8ce8SChinh T Cao prot_id == ICE_APP_PROT_ID_ISCSI_860)) {
864aeac8ce8SChinh T Cao ice_app_prot_id_type = prot_id;
865aeac8ce8SChinh T Cao break;
866aeac8ce8SChinh T Cao }
867aeac8ce8SChinh T Cao }
8680ebd3ff1SAnirudh Venkataramanan } else {
8690ebd3ff1SAnirudh Venkataramanan /* FIP APP */
8700ebd3ff1SAnirudh Venkataramanan ice_aqc_cee_status_mask = ICE_AQC_CEE_FIP_STATUS_M;
8710ebd3ff1SAnirudh Venkataramanan ice_aqc_cee_status_shift = ICE_AQC_CEE_FIP_STATUS_S;
8720ebd3ff1SAnirudh Venkataramanan ice_aqc_cee_app_mask = ICE_AQC_CEE_APP_FIP_M;
8730ebd3ff1SAnirudh Venkataramanan ice_aqc_cee_app_shift = ICE_AQC_CEE_APP_FIP_S;
8740ebd3ff1SAnirudh Venkataramanan ice_app_sel_type = ICE_APP_SEL_ETHTYPE;
875d41f26b5SBruce Allan ice_app_prot_id_type = ETH_P_FIP;
8760ebd3ff1SAnirudh Venkataramanan }
8770ebd3ff1SAnirudh Venkataramanan
8780ebd3ff1SAnirudh Venkataramanan status = (tlv_status & ice_aqc_cee_status_mask) >>
8790ebd3ff1SAnirudh Venkataramanan ice_aqc_cee_status_shift;
8800ebd3ff1SAnirudh Venkataramanan err = (status & ICE_TLV_STATUS_ERR) ? 1 : 0;
8810ebd3ff1SAnirudh Venkataramanan sync = (status & ICE_TLV_STATUS_SYNC) ? 1 : 0;
8820ebd3ff1SAnirudh Venkataramanan oper = (status & ICE_TLV_STATUS_OPER) ? 1 : 0;
8830ebd3ff1SAnirudh Venkataramanan /* Add FCoE/iSCSI/FIP APP if Error is False and
8840ebd3ff1SAnirudh Venkataramanan * Oper/Sync is True
8850ebd3ff1SAnirudh Venkataramanan */
8860ebd3ff1SAnirudh Venkataramanan if (!err && sync && oper) {
8870ebd3ff1SAnirudh Venkataramanan dcbcfg->app[app_index].priority =
8880ebd3ff1SAnirudh Venkataramanan (app_prio & ice_aqc_cee_app_mask) >>
8890ebd3ff1SAnirudh Venkataramanan ice_aqc_cee_app_shift;
8900ebd3ff1SAnirudh Venkataramanan dcbcfg->app[app_index].selector = ice_app_sel_type;
8910ebd3ff1SAnirudh Venkataramanan dcbcfg->app[app_index].prot_id = ice_app_prot_id_type;
8920ebd3ff1SAnirudh Venkataramanan app_index++;
8930ebd3ff1SAnirudh Venkataramanan }
8940ebd3ff1SAnirudh Venkataramanan }
8950ebd3ff1SAnirudh Venkataramanan
8960ebd3ff1SAnirudh Venkataramanan dcbcfg->numapps = app_index;
8970ebd3ff1SAnirudh Venkataramanan }
8980ebd3ff1SAnirudh Venkataramanan
8990ebd3ff1SAnirudh Venkataramanan /**
900ef860480STony Nguyen * ice_get_ieee_or_cee_dcb_cfg
9010ebd3ff1SAnirudh Venkataramanan * @pi: port information structure
9020ebd3ff1SAnirudh Venkataramanan * @dcbx_mode: mode of DCBX (IEEE or CEE)
9030ebd3ff1SAnirudh Venkataramanan *
9040ebd3ff1SAnirudh Venkataramanan * Get IEEE or CEE mode DCB configuration from the Firmware
9050ebd3ff1SAnirudh Venkataramanan */
ice_get_ieee_or_cee_dcb_cfg(struct ice_port_info * pi,u8 dcbx_mode)9065518ac2aSTony Nguyen static int ice_get_ieee_or_cee_dcb_cfg(struct ice_port_info *pi, u8 dcbx_mode)
9070ebd3ff1SAnirudh Venkataramanan {
9080ebd3ff1SAnirudh Venkataramanan struct ice_dcbx_cfg *dcbx_cfg = NULL;
9095e24d598STony Nguyen int ret;
9100ebd3ff1SAnirudh Venkataramanan
9110ebd3ff1SAnirudh Venkataramanan if (!pi)
912d54699e2STony Nguyen return -EINVAL;
9130ebd3ff1SAnirudh Venkataramanan
9140ebd3ff1SAnirudh Venkataramanan if (dcbx_mode == ICE_DCBX_MODE_IEEE)
915fc2d1165SChinh T Cao dcbx_cfg = &pi->qos_cfg.local_dcbx_cfg;
9160ebd3ff1SAnirudh Venkataramanan else if (dcbx_mode == ICE_DCBX_MODE_CEE)
917fc2d1165SChinh T Cao dcbx_cfg = &pi->qos_cfg.desired_dcbx_cfg;
9180ebd3ff1SAnirudh Venkataramanan
9190ebd3ff1SAnirudh Venkataramanan /* Get Local DCB Config in case of ICE_DCBX_MODE_IEEE
9200ebd3ff1SAnirudh Venkataramanan * or get CEE DCB Desired Config in case of ICE_DCBX_MODE_CEE
9210ebd3ff1SAnirudh Venkataramanan */
9220ebd3ff1SAnirudh Venkataramanan ret = ice_aq_get_dcb_cfg(pi->hw, ICE_AQ_LLDP_MIB_LOCAL,
9230ebd3ff1SAnirudh Venkataramanan ICE_AQ_LLDP_BRID_TYPE_NEAREST_BRID, dcbx_cfg);
9240ebd3ff1SAnirudh Venkataramanan if (ret)
9250ebd3ff1SAnirudh Venkataramanan goto out;
9260ebd3ff1SAnirudh Venkataramanan
9270ebd3ff1SAnirudh Venkataramanan /* Get Remote DCB Config */
928fc2d1165SChinh T Cao dcbx_cfg = &pi->qos_cfg.remote_dcbx_cfg;
9290ebd3ff1SAnirudh Venkataramanan ret = ice_aq_get_dcb_cfg(pi->hw, ICE_AQ_LLDP_MIB_REMOTE,
9300ebd3ff1SAnirudh Venkataramanan ICE_AQ_LLDP_BRID_TYPE_NEAREST_BRID, dcbx_cfg);
9310ebd3ff1SAnirudh Venkataramanan /* Don't treat ENOENT as an error for Remote MIBs */
9320ebd3ff1SAnirudh Venkataramanan if (pi->hw->adminq.sq_last_status == ICE_AQ_RC_ENOENT)
9330ebd3ff1SAnirudh Venkataramanan ret = 0;
9340ebd3ff1SAnirudh Venkataramanan
9350ebd3ff1SAnirudh Venkataramanan out:
9360ebd3ff1SAnirudh Venkataramanan return ret;
9370ebd3ff1SAnirudh Venkataramanan }
9380ebd3ff1SAnirudh Venkataramanan
9390ebd3ff1SAnirudh Venkataramanan /**
9400ebd3ff1SAnirudh Venkataramanan * ice_get_dcb_cfg
9410ebd3ff1SAnirudh Venkataramanan * @pi: port information structure
9420ebd3ff1SAnirudh Venkataramanan *
9430ebd3ff1SAnirudh Venkataramanan * Get DCB configuration from the Firmware
9440ebd3ff1SAnirudh Venkataramanan */
ice_get_dcb_cfg(struct ice_port_info * pi)9455e24d598STony Nguyen int ice_get_dcb_cfg(struct ice_port_info *pi)
9460ebd3ff1SAnirudh Venkataramanan {
9470ebd3ff1SAnirudh Venkataramanan struct ice_aqc_get_cee_dcb_cfg_resp cee_cfg;
9480ebd3ff1SAnirudh Venkataramanan struct ice_dcbx_cfg *dcbx_cfg;
9495e24d598STony Nguyen int ret;
9500ebd3ff1SAnirudh Venkataramanan
9510ebd3ff1SAnirudh Venkataramanan if (!pi)
952d54699e2STony Nguyen return -EINVAL;
9530ebd3ff1SAnirudh Venkataramanan
9540ebd3ff1SAnirudh Venkataramanan ret = ice_aq_get_cee_dcb_cfg(pi->hw, &cee_cfg, NULL);
9550ebd3ff1SAnirudh Venkataramanan if (!ret) {
9560ebd3ff1SAnirudh Venkataramanan /* CEE mode */
9570ebd3ff1SAnirudh Venkataramanan ret = ice_get_ieee_or_cee_dcb_cfg(pi, ICE_DCBX_MODE_CEE);
958aeac8ce8SChinh T Cao ice_cee_to_dcb_cfg(&cee_cfg, pi);
9590ebd3ff1SAnirudh Venkataramanan } else if (pi->hw->adminq.sq_last_status == ICE_AQ_RC_ENOENT) {
9600ebd3ff1SAnirudh Venkataramanan /* CEE mode not enabled try querying IEEE data */
961fc2d1165SChinh T Cao dcbx_cfg = &pi->qos_cfg.local_dcbx_cfg;
9620ebd3ff1SAnirudh Venkataramanan dcbx_cfg->dcbx_mode = ICE_DCBX_MODE_IEEE;
9630ebd3ff1SAnirudh Venkataramanan ret = ice_get_ieee_or_cee_dcb_cfg(pi, ICE_DCBX_MODE_IEEE);
9640ebd3ff1SAnirudh Venkataramanan }
9650ebd3ff1SAnirudh Venkataramanan
9660ebd3ff1SAnirudh Venkataramanan return ret;
9670ebd3ff1SAnirudh Venkataramanan }
9680ebd3ff1SAnirudh Venkataramanan
9690ebd3ff1SAnirudh Venkataramanan /**
9707d8d7754SAnatolii Gerasymenko * ice_get_dcb_cfg_from_mib_change
9717d8d7754SAnatolii Gerasymenko * @pi: port information structure
9727d8d7754SAnatolii Gerasymenko * @event: pointer to the admin queue receive event
9737d8d7754SAnatolii Gerasymenko *
9747d8d7754SAnatolii Gerasymenko * Set DCB configuration from received MIB Change event
9757d8d7754SAnatolii Gerasymenko */
ice_get_dcb_cfg_from_mib_change(struct ice_port_info * pi,struct ice_rq_event_info * event)9767d8d7754SAnatolii Gerasymenko void ice_get_dcb_cfg_from_mib_change(struct ice_port_info *pi,
9777d8d7754SAnatolii Gerasymenko struct ice_rq_event_info *event)
9787d8d7754SAnatolii Gerasymenko {
9797d8d7754SAnatolii Gerasymenko struct ice_dcbx_cfg *dcbx_cfg = &pi->qos_cfg.local_dcbx_cfg;
9807d8d7754SAnatolii Gerasymenko struct ice_aqc_lldp_get_mib *mib;
9817d8d7754SAnatolii Gerasymenko u8 change_type, dcbx_mode;
9827d8d7754SAnatolii Gerasymenko
9837d8d7754SAnatolii Gerasymenko mib = (struct ice_aqc_lldp_get_mib *)&event->desc.params.raw;
9847d8d7754SAnatolii Gerasymenko
9857d8d7754SAnatolii Gerasymenko change_type = FIELD_GET(ICE_AQ_LLDP_MIB_TYPE_M, mib->type);
9867d8d7754SAnatolii Gerasymenko if (change_type == ICE_AQ_LLDP_MIB_REMOTE)
9877d8d7754SAnatolii Gerasymenko dcbx_cfg = &pi->qos_cfg.remote_dcbx_cfg;
9887d8d7754SAnatolii Gerasymenko
9897d8d7754SAnatolii Gerasymenko dcbx_mode = FIELD_GET(ICE_AQ_LLDP_DCBX_M, mib->type);
9907d8d7754SAnatolii Gerasymenko
9917d8d7754SAnatolii Gerasymenko switch (dcbx_mode) {
9927d8d7754SAnatolii Gerasymenko case ICE_AQ_LLDP_DCBX_IEEE:
9937d8d7754SAnatolii Gerasymenko dcbx_cfg->dcbx_mode = ICE_DCBX_MODE_IEEE;
9947d8d7754SAnatolii Gerasymenko ice_lldp_to_dcb_cfg(event->msg_buf, dcbx_cfg);
9957d8d7754SAnatolii Gerasymenko break;
9967d8d7754SAnatolii Gerasymenko
9977d8d7754SAnatolii Gerasymenko case ICE_AQ_LLDP_DCBX_CEE:
9987d8d7754SAnatolii Gerasymenko pi->qos_cfg.desired_dcbx_cfg = pi->qos_cfg.local_dcbx_cfg;
9997d8d7754SAnatolii Gerasymenko ice_cee_to_dcb_cfg((struct ice_aqc_get_cee_dcb_cfg_resp *)
10007d8d7754SAnatolii Gerasymenko event->msg_buf, pi);
10017d8d7754SAnatolii Gerasymenko break;
10027d8d7754SAnatolii Gerasymenko }
10037d8d7754SAnatolii Gerasymenko }
10047d8d7754SAnatolii Gerasymenko
10057d8d7754SAnatolii Gerasymenko /**
10060ebd3ff1SAnirudh Venkataramanan * ice_init_dcb
10070ebd3ff1SAnirudh Venkataramanan * @hw: pointer to the HW struct
1008ea300f41SDave Ertman * @enable_mib_change: enable MIB change event
10090ebd3ff1SAnirudh Venkataramanan *
10100ebd3ff1SAnirudh Venkataramanan * Update DCB configuration from the Firmware
10110ebd3ff1SAnirudh Venkataramanan */
ice_init_dcb(struct ice_hw * hw,bool enable_mib_change)10125e24d598STony Nguyen int ice_init_dcb(struct ice_hw *hw, bool enable_mib_change)
10130ebd3ff1SAnirudh Venkataramanan {
1014fc2d1165SChinh T Cao struct ice_qos_cfg *qos_cfg = &hw->port_info->qos_cfg;
10155e24d598STony Nguyen int ret = 0;
10160ebd3ff1SAnirudh Venkataramanan
10170ebd3ff1SAnirudh Venkataramanan if (!hw->func_caps.common_cap.dcb)
1018d54699e2STony Nguyen return -EOPNOTSUPP;
10190ebd3ff1SAnirudh Venkataramanan
1020fc2d1165SChinh T Cao qos_cfg->is_sw_lldp = true;
10210ebd3ff1SAnirudh Venkataramanan
10220ebd3ff1SAnirudh Venkataramanan /* Get DCBX status */
1023fc2d1165SChinh T Cao qos_cfg->dcbx_status = ice_get_dcbx_status(hw);
10240ebd3ff1SAnirudh Venkataramanan
1025fc2d1165SChinh T Cao if (qos_cfg->dcbx_status == ICE_DCBX_STATUS_DONE ||
1026fc2d1165SChinh T Cao qos_cfg->dcbx_status == ICE_DCBX_STATUS_IN_PROGRESS ||
1027fc2d1165SChinh T Cao qos_cfg->dcbx_status == ICE_DCBX_STATUS_NOT_STARTED) {
10280ebd3ff1SAnirudh Venkataramanan /* Get current DCBX configuration */
1029fc2d1165SChinh T Cao ret = ice_get_dcb_cfg(hw->port_info);
10300ebd3ff1SAnirudh Venkataramanan if (ret)
10310ebd3ff1SAnirudh Venkataramanan return ret;
1032fc2d1165SChinh T Cao qos_cfg->is_sw_lldp = false;
1033fc2d1165SChinh T Cao } else if (qos_cfg->dcbx_status == ICE_DCBX_STATUS_DIS) {
1034d54699e2STony Nguyen return -EBUSY;
10350ebd3ff1SAnirudh Venkataramanan }
10360ebd3ff1SAnirudh Venkataramanan
10370ebd3ff1SAnirudh Venkataramanan /* Configure the LLDP MIB change event */
1038ea300f41SDave Ertman if (enable_mib_change) {
10390ebd3ff1SAnirudh Venkataramanan ret = ice_aq_cfg_lldp_mib_change(hw, true, NULL);
1040b2883dfeSDave Ertman if (ret)
1041fc2d1165SChinh T Cao qos_cfg->is_sw_lldp = true;
1042ea300f41SDave Ertman }
1043ea300f41SDave Ertman
1044ea300f41SDave Ertman return ret;
1045ea300f41SDave Ertman }
1046ea300f41SDave Ertman
1047ea300f41SDave Ertman /**
1048ea300f41SDave Ertman * ice_cfg_lldp_mib_change
1049ea300f41SDave Ertman * @hw: pointer to the HW struct
1050ea300f41SDave Ertman * @ena_mib: enable/disable MIB change event
1051ea300f41SDave Ertman *
1052ea300f41SDave Ertman * Configure (disable/enable) MIB
1053ea300f41SDave Ertman */
ice_cfg_lldp_mib_change(struct ice_hw * hw,bool ena_mib)10545e24d598STony Nguyen int ice_cfg_lldp_mib_change(struct ice_hw *hw, bool ena_mib)
1055ea300f41SDave Ertman {
1056fc2d1165SChinh T Cao struct ice_qos_cfg *qos_cfg = &hw->port_info->qos_cfg;
10575e24d598STony Nguyen int ret;
1058ea300f41SDave Ertman
1059ea300f41SDave Ertman if (!hw->func_caps.common_cap.dcb)
1060d54699e2STony Nguyen return -EOPNOTSUPP;
1061ea300f41SDave Ertman
1062ea300f41SDave Ertman /* Get DCBX status */
1063fc2d1165SChinh T Cao qos_cfg->dcbx_status = ice_get_dcbx_status(hw);
1064ea300f41SDave Ertman
1065fc2d1165SChinh T Cao if (qos_cfg->dcbx_status == ICE_DCBX_STATUS_DIS)
1066d54699e2STony Nguyen return -EBUSY;
1067ea300f41SDave Ertman
1068ea300f41SDave Ertman ret = ice_aq_cfg_lldp_mib_change(hw, ena_mib, NULL);
1069ea300f41SDave Ertman if (!ret)
1070fc2d1165SChinh T Cao qos_cfg->is_sw_lldp = !ena_mib;
10710ebd3ff1SAnirudh Venkataramanan
10720ebd3ff1SAnirudh Venkataramanan return ret;
10730ebd3ff1SAnirudh Venkataramanan }
10747b9ffc76SAnirudh Venkataramanan
10757b9ffc76SAnirudh Venkataramanan /**
10767b9ffc76SAnirudh Venkataramanan * ice_add_ieee_ets_common_tlv
10777b9ffc76SAnirudh Venkataramanan * @buf: Data buffer to be populated with ice_dcb_ets_cfg data
10787b9ffc76SAnirudh Venkataramanan * @ets_cfg: Container for ice_dcb_ets_cfg data
10797b9ffc76SAnirudh Venkataramanan *
10807b9ffc76SAnirudh Venkataramanan * Populate the TLV buffer with ice_dcb_ets_cfg data
10817b9ffc76SAnirudh Venkataramanan */
10827b9ffc76SAnirudh Venkataramanan static void
ice_add_ieee_ets_common_tlv(u8 * buf,struct ice_dcb_ets_cfg * ets_cfg)10837b9ffc76SAnirudh Venkataramanan ice_add_ieee_ets_common_tlv(u8 *buf, struct ice_dcb_ets_cfg *ets_cfg)
10847b9ffc76SAnirudh Venkataramanan {
10857b9ffc76SAnirudh Venkataramanan u8 priority0, priority1;
10867b9ffc76SAnirudh Venkataramanan u8 offset = 0;
10877b9ffc76SAnirudh Venkataramanan int i;
10887b9ffc76SAnirudh Venkataramanan
10897b9ffc76SAnirudh Venkataramanan /* Priority Assignment Table (4 octets)
10907b9ffc76SAnirudh Venkataramanan * Octets:| 1 | 2 | 3 | 4 |
10917b9ffc76SAnirudh Venkataramanan * -----------------------------------------
10927b9ffc76SAnirudh Venkataramanan * |pri0|pri1|pri2|pri3|pri4|pri5|pri6|pri7|
10937b9ffc76SAnirudh Venkataramanan * -----------------------------------------
10947b9ffc76SAnirudh Venkataramanan * Bits:|7 4|3 0|7 4|3 0|7 4|3 0|7 4|3 0|
10957b9ffc76SAnirudh Venkataramanan * -----------------------------------------
10967b9ffc76SAnirudh Venkataramanan */
10977b9ffc76SAnirudh Venkataramanan for (i = 0; i < ICE_MAX_TRAFFIC_CLASS / 2; i++) {
10987b9ffc76SAnirudh Venkataramanan priority0 = ets_cfg->prio_table[i * 2] & 0xF;
10997b9ffc76SAnirudh Venkataramanan priority1 = ets_cfg->prio_table[i * 2 + 1] & 0xF;
11007b9ffc76SAnirudh Venkataramanan buf[offset] = (priority0 << ICE_IEEE_ETS_PRIO_1_S) | priority1;
11017b9ffc76SAnirudh Venkataramanan offset++;
11027b9ffc76SAnirudh Venkataramanan }
11037b9ffc76SAnirudh Venkataramanan
11047b9ffc76SAnirudh Venkataramanan /* TC Bandwidth Table (8 octets)
11057b9ffc76SAnirudh Venkataramanan * Octets:| 1 | 2 | 3 | 4 | 5 | 6 | 7 | 8 |
11067b9ffc76SAnirudh Venkataramanan * ---------------------------------
11077b9ffc76SAnirudh Venkataramanan * |tc0|tc1|tc2|tc3|tc4|tc5|tc6|tc7|
11087b9ffc76SAnirudh Venkataramanan * ---------------------------------
11097b9ffc76SAnirudh Venkataramanan *
11107b9ffc76SAnirudh Venkataramanan * TSA Assignment Table (8 octets)
11117b9ffc76SAnirudh Venkataramanan * Octets:| 1 | 2 | 3 | 4 | 5 | 6 | 7 | 8 |
11127b9ffc76SAnirudh Venkataramanan * ---------------------------------
11137b9ffc76SAnirudh Venkataramanan * |tc0|tc1|tc2|tc3|tc4|tc5|tc6|tc7|
11147b9ffc76SAnirudh Venkataramanan * ---------------------------------
11157b9ffc76SAnirudh Venkataramanan */
11167b9ffc76SAnirudh Venkataramanan ice_for_each_traffic_class(i) {
11177b9ffc76SAnirudh Venkataramanan buf[offset] = ets_cfg->tcbwtable[i];
11187b9ffc76SAnirudh Venkataramanan buf[ICE_MAX_TRAFFIC_CLASS + offset] = ets_cfg->tsatable[i];
11197b9ffc76SAnirudh Venkataramanan offset++;
11207b9ffc76SAnirudh Venkataramanan }
11217b9ffc76SAnirudh Venkataramanan }
11227b9ffc76SAnirudh Venkataramanan
11237b9ffc76SAnirudh Venkataramanan /**
11247b9ffc76SAnirudh Venkataramanan * ice_add_ieee_ets_tlv - Prepare ETS TLV in IEEE format
11257b9ffc76SAnirudh Venkataramanan * @tlv: Fill the ETS config data in IEEE format
11267b9ffc76SAnirudh Venkataramanan * @dcbcfg: Local store which holds the DCB Config
11277b9ffc76SAnirudh Venkataramanan *
11287b9ffc76SAnirudh Venkataramanan * Prepare IEEE 802.1Qaz ETS CFG TLV
11297b9ffc76SAnirudh Venkataramanan */
11307b9ffc76SAnirudh Venkataramanan static void
ice_add_ieee_ets_tlv(struct ice_lldp_org_tlv * tlv,struct ice_dcbx_cfg * dcbcfg)11317b9ffc76SAnirudh Venkataramanan ice_add_ieee_ets_tlv(struct ice_lldp_org_tlv *tlv, struct ice_dcbx_cfg *dcbcfg)
11327b9ffc76SAnirudh Venkataramanan {
11337b9ffc76SAnirudh Venkataramanan struct ice_dcb_ets_cfg *etscfg;
11347b9ffc76SAnirudh Venkataramanan u8 *buf = tlv->tlvinfo;
11357b9ffc76SAnirudh Venkataramanan u8 maxtcwilling = 0;
11367b9ffc76SAnirudh Venkataramanan u32 ouisubtype;
11377b9ffc76SAnirudh Venkataramanan u16 typelen;
11387b9ffc76SAnirudh Venkataramanan
11397b9ffc76SAnirudh Venkataramanan typelen = ((ICE_TLV_TYPE_ORG << ICE_LLDP_TLV_TYPE_S) |
11407b9ffc76SAnirudh Venkataramanan ICE_IEEE_ETS_TLV_LEN);
11417b9ffc76SAnirudh Venkataramanan tlv->typelen = htons(typelen);
11427b9ffc76SAnirudh Venkataramanan
11437b9ffc76SAnirudh Venkataramanan ouisubtype = ((ICE_IEEE_8021QAZ_OUI << ICE_LLDP_TLV_OUI_S) |
11447b9ffc76SAnirudh Venkataramanan ICE_IEEE_SUBTYPE_ETS_CFG);
11457b9ffc76SAnirudh Venkataramanan tlv->ouisubtype = htonl(ouisubtype);
11467b9ffc76SAnirudh Venkataramanan
11477b9ffc76SAnirudh Venkataramanan /* First Octet post subtype
11487b9ffc76SAnirudh Venkataramanan * --------------------------
11497b9ffc76SAnirudh Venkataramanan * |will-|CBS | Re- | Max |
11507b9ffc76SAnirudh Venkataramanan * |ing | |served| TCs |
11517b9ffc76SAnirudh Venkataramanan * --------------------------
11527b9ffc76SAnirudh Venkataramanan * |1bit | 1bit|3 bits|3bits|
11537b9ffc76SAnirudh Venkataramanan */
11547b9ffc76SAnirudh Venkataramanan etscfg = &dcbcfg->etscfg;
11557b9ffc76SAnirudh Venkataramanan if (etscfg->willing)
11567b9ffc76SAnirudh Venkataramanan maxtcwilling = BIT(ICE_IEEE_ETS_WILLING_S);
11577b9ffc76SAnirudh Venkataramanan maxtcwilling |= etscfg->maxtcs & ICE_IEEE_ETS_MAXTC_M;
11587b9ffc76SAnirudh Venkataramanan buf[0] = maxtcwilling;
11597b9ffc76SAnirudh Venkataramanan
11607b9ffc76SAnirudh Venkataramanan /* Begin adding at Priority Assignment Table (offset 1 in buf) */
11617b9ffc76SAnirudh Venkataramanan ice_add_ieee_ets_common_tlv(&buf[1], etscfg);
11627b9ffc76SAnirudh Venkataramanan }
11637b9ffc76SAnirudh Venkataramanan
11647b9ffc76SAnirudh Venkataramanan /**
11657b9ffc76SAnirudh Venkataramanan * ice_add_ieee_etsrec_tlv - Prepare ETS Recommended TLV in IEEE format
11667b9ffc76SAnirudh Venkataramanan * @tlv: Fill ETS Recommended TLV in IEEE format
11677b9ffc76SAnirudh Venkataramanan * @dcbcfg: Local store which holds the DCB Config
11687b9ffc76SAnirudh Venkataramanan *
11697b9ffc76SAnirudh Venkataramanan * Prepare IEEE 802.1Qaz ETS REC TLV
11707b9ffc76SAnirudh Venkataramanan */
11717b9ffc76SAnirudh Venkataramanan static void
ice_add_ieee_etsrec_tlv(struct ice_lldp_org_tlv * tlv,struct ice_dcbx_cfg * dcbcfg)11727b9ffc76SAnirudh Venkataramanan ice_add_ieee_etsrec_tlv(struct ice_lldp_org_tlv *tlv,
11737b9ffc76SAnirudh Venkataramanan struct ice_dcbx_cfg *dcbcfg)
11747b9ffc76SAnirudh Venkataramanan {
11757b9ffc76SAnirudh Venkataramanan struct ice_dcb_ets_cfg *etsrec;
11767b9ffc76SAnirudh Venkataramanan u8 *buf = tlv->tlvinfo;
11777b9ffc76SAnirudh Venkataramanan u32 ouisubtype;
11787b9ffc76SAnirudh Venkataramanan u16 typelen;
11797b9ffc76SAnirudh Venkataramanan
11807b9ffc76SAnirudh Venkataramanan typelen = ((ICE_TLV_TYPE_ORG << ICE_LLDP_TLV_TYPE_S) |
11817b9ffc76SAnirudh Venkataramanan ICE_IEEE_ETS_TLV_LEN);
11827b9ffc76SAnirudh Venkataramanan tlv->typelen = htons(typelen);
11837b9ffc76SAnirudh Venkataramanan
11847b9ffc76SAnirudh Venkataramanan ouisubtype = ((ICE_IEEE_8021QAZ_OUI << ICE_LLDP_TLV_OUI_S) |
11857b9ffc76SAnirudh Venkataramanan ICE_IEEE_SUBTYPE_ETS_REC);
11867b9ffc76SAnirudh Venkataramanan tlv->ouisubtype = htonl(ouisubtype);
11877b9ffc76SAnirudh Venkataramanan
11887b9ffc76SAnirudh Venkataramanan etsrec = &dcbcfg->etsrec;
11897b9ffc76SAnirudh Venkataramanan
11907b9ffc76SAnirudh Venkataramanan /* First Octet is reserved */
11917b9ffc76SAnirudh Venkataramanan /* Begin adding at Priority Assignment Table (offset 1 in buf) */
11927b9ffc76SAnirudh Venkataramanan ice_add_ieee_ets_common_tlv(&buf[1], etsrec);
11937b9ffc76SAnirudh Venkataramanan }
11947b9ffc76SAnirudh Venkataramanan
11957b9ffc76SAnirudh Venkataramanan /**
11967b9ffc76SAnirudh Venkataramanan * ice_add_ieee_pfc_tlv - Prepare PFC TLV in IEEE format
11977b9ffc76SAnirudh Venkataramanan * @tlv: Fill PFC TLV in IEEE format
11987b9ffc76SAnirudh Venkataramanan * @dcbcfg: Local store which holds the PFC CFG data
11997b9ffc76SAnirudh Venkataramanan *
12007b9ffc76SAnirudh Venkataramanan * Prepare IEEE 802.1Qaz PFC CFG TLV
12017b9ffc76SAnirudh Venkataramanan */
12027b9ffc76SAnirudh Venkataramanan static void
ice_add_ieee_pfc_tlv(struct ice_lldp_org_tlv * tlv,struct ice_dcbx_cfg * dcbcfg)12037b9ffc76SAnirudh Venkataramanan ice_add_ieee_pfc_tlv(struct ice_lldp_org_tlv *tlv, struct ice_dcbx_cfg *dcbcfg)
12047b9ffc76SAnirudh Venkataramanan {
12057b9ffc76SAnirudh Venkataramanan u8 *buf = tlv->tlvinfo;
12067b9ffc76SAnirudh Venkataramanan u32 ouisubtype;
12077b9ffc76SAnirudh Venkataramanan u16 typelen;
12087b9ffc76SAnirudh Venkataramanan
12097b9ffc76SAnirudh Venkataramanan typelen = ((ICE_TLV_TYPE_ORG << ICE_LLDP_TLV_TYPE_S) |
12107b9ffc76SAnirudh Venkataramanan ICE_IEEE_PFC_TLV_LEN);
12117b9ffc76SAnirudh Venkataramanan tlv->typelen = htons(typelen);
12127b9ffc76SAnirudh Venkataramanan
12137b9ffc76SAnirudh Venkataramanan ouisubtype = ((ICE_IEEE_8021QAZ_OUI << ICE_LLDP_TLV_OUI_S) |
12147b9ffc76SAnirudh Venkataramanan ICE_IEEE_SUBTYPE_PFC_CFG);
12157b9ffc76SAnirudh Venkataramanan tlv->ouisubtype = htonl(ouisubtype);
12167b9ffc76SAnirudh Venkataramanan
12177b9ffc76SAnirudh Venkataramanan /* ----------------------------------------
12187b9ffc76SAnirudh Venkataramanan * |will-|MBC | Re- | PFC | PFC Enable |
12197b9ffc76SAnirudh Venkataramanan * |ing | |served| cap | |
12207b9ffc76SAnirudh Venkataramanan * -----------------------------------------
12217b9ffc76SAnirudh Venkataramanan * |1bit | 1bit|2 bits|4bits| 1 octet |
12227b9ffc76SAnirudh Venkataramanan */
12237b9ffc76SAnirudh Venkataramanan if (dcbcfg->pfc.willing)
12247b9ffc76SAnirudh Venkataramanan buf[0] = BIT(ICE_IEEE_PFC_WILLING_S);
12257b9ffc76SAnirudh Venkataramanan
12267b9ffc76SAnirudh Venkataramanan if (dcbcfg->pfc.mbc)
12277b9ffc76SAnirudh Venkataramanan buf[0] |= BIT(ICE_IEEE_PFC_MBC_S);
12287b9ffc76SAnirudh Venkataramanan
12297b9ffc76SAnirudh Venkataramanan buf[0] |= dcbcfg->pfc.pfccap & 0xF;
12307b9ffc76SAnirudh Venkataramanan buf[1] = dcbcfg->pfc.pfcena;
12317b9ffc76SAnirudh Venkataramanan }
12327b9ffc76SAnirudh Venkataramanan
12337b9ffc76SAnirudh Venkataramanan /**
12347b9ffc76SAnirudh Venkataramanan * ice_add_ieee_app_pri_tlv - Prepare APP TLV in IEEE format
12357b9ffc76SAnirudh Venkataramanan * @tlv: Fill APP TLV in IEEE format
12367b9ffc76SAnirudh Venkataramanan * @dcbcfg: Local store which holds the APP CFG data
12377b9ffc76SAnirudh Venkataramanan *
12387b9ffc76SAnirudh Venkataramanan * Prepare IEEE 802.1Qaz APP CFG TLV
12397b9ffc76SAnirudh Venkataramanan */
12407b9ffc76SAnirudh Venkataramanan static void
ice_add_ieee_app_pri_tlv(struct ice_lldp_org_tlv * tlv,struct ice_dcbx_cfg * dcbcfg)12417b9ffc76SAnirudh Venkataramanan ice_add_ieee_app_pri_tlv(struct ice_lldp_org_tlv *tlv,
12427b9ffc76SAnirudh Venkataramanan struct ice_dcbx_cfg *dcbcfg)
12437b9ffc76SAnirudh Venkataramanan {
12447b9ffc76SAnirudh Venkataramanan u16 typelen, len, offset = 0;
12457b9ffc76SAnirudh Venkataramanan u8 priority, selector, i = 0;
12467b9ffc76SAnirudh Venkataramanan u8 *buf = tlv->tlvinfo;
12477b9ffc76SAnirudh Venkataramanan u32 ouisubtype;
12487b9ffc76SAnirudh Venkataramanan
12497b9ffc76SAnirudh Venkataramanan /* No APP TLVs then just return */
12507b9ffc76SAnirudh Venkataramanan if (dcbcfg->numapps == 0)
12517b9ffc76SAnirudh Venkataramanan return;
12527b9ffc76SAnirudh Venkataramanan ouisubtype = ((ICE_IEEE_8021QAZ_OUI << ICE_LLDP_TLV_OUI_S) |
12537b9ffc76SAnirudh Venkataramanan ICE_IEEE_SUBTYPE_APP_PRI);
12547b9ffc76SAnirudh Venkataramanan tlv->ouisubtype = htonl(ouisubtype);
12557b9ffc76SAnirudh Venkataramanan
12567b9ffc76SAnirudh Venkataramanan /* Move offset to App Priority Table */
12577b9ffc76SAnirudh Venkataramanan offset++;
12587b9ffc76SAnirudh Venkataramanan /* Application Priority Table (3 octets)
12597b9ffc76SAnirudh Venkataramanan * Octets:| 1 | 2 | 3 |
12607b9ffc76SAnirudh Venkataramanan * -----------------------------------------
12617b9ffc76SAnirudh Venkataramanan * |Priority|Rsrvd| Sel | Protocol ID |
12627b9ffc76SAnirudh Venkataramanan * -----------------------------------------
12637b9ffc76SAnirudh Venkataramanan * Bits:|23 21|20 19|18 16|15 0|
12647b9ffc76SAnirudh Venkataramanan * -----------------------------------------
12657b9ffc76SAnirudh Venkataramanan */
12667b9ffc76SAnirudh Venkataramanan while (i < dcbcfg->numapps) {
12677b9ffc76SAnirudh Venkataramanan priority = dcbcfg->app[i].priority & 0x7;
12687b9ffc76SAnirudh Venkataramanan selector = dcbcfg->app[i].selector & 0x7;
12697b9ffc76SAnirudh Venkataramanan buf[offset] = (priority << ICE_IEEE_APP_PRIO_S) | selector;
12707b9ffc76SAnirudh Venkataramanan buf[offset + 1] = (dcbcfg->app[i].prot_id >> 0x8) & 0xFF;
12717b9ffc76SAnirudh Venkataramanan buf[offset + 2] = dcbcfg->app[i].prot_id & 0xFF;
12727b9ffc76SAnirudh Venkataramanan /* Move to next app */
12737b9ffc76SAnirudh Venkataramanan offset += 3;
12747b9ffc76SAnirudh Venkataramanan i++;
12757b9ffc76SAnirudh Venkataramanan if (i >= ICE_DCBX_MAX_APPS)
12767b9ffc76SAnirudh Venkataramanan break;
12777b9ffc76SAnirudh Venkataramanan }
12787b9ffc76SAnirudh Venkataramanan /* len includes size of ouisubtype + 1 reserved + 3*numapps */
12797b9ffc76SAnirudh Venkataramanan len = sizeof(tlv->ouisubtype) + 1 + (i * 3);
12807b9ffc76SAnirudh Venkataramanan typelen = ((ICE_TLV_TYPE_ORG << ICE_LLDP_TLV_TYPE_S) | (len & 0x1FF));
12817b9ffc76SAnirudh Venkataramanan tlv->typelen = htons(typelen);
12827b9ffc76SAnirudh Venkataramanan }
12837b9ffc76SAnirudh Venkataramanan
12847b9ffc76SAnirudh Venkataramanan /**
12852a87bd73SDave Ertman * ice_add_dscp_up_tlv - Prepare DSCP to UP TLV
12862a87bd73SDave Ertman * @tlv: location to build the TLV data
12872a87bd73SDave Ertman * @dcbcfg: location of data to convert to TLV
12882a87bd73SDave Ertman */
12892a87bd73SDave Ertman static void
ice_add_dscp_up_tlv(struct ice_lldp_org_tlv * tlv,struct ice_dcbx_cfg * dcbcfg)12902a87bd73SDave Ertman ice_add_dscp_up_tlv(struct ice_lldp_org_tlv *tlv, struct ice_dcbx_cfg *dcbcfg)
12912a87bd73SDave Ertman {
12922a87bd73SDave Ertman u8 *buf = tlv->tlvinfo;
12932a87bd73SDave Ertman u32 ouisubtype;
12942a87bd73SDave Ertman u16 typelen;
12952a87bd73SDave Ertman int i;
12962a87bd73SDave Ertman
12972a87bd73SDave Ertman typelen = ((ICE_TLV_TYPE_ORG << ICE_LLDP_TLV_TYPE_S) |
12982a87bd73SDave Ertman ICE_DSCP_UP_TLV_LEN);
12992a87bd73SDave Ertman tlv->typelen = htons(typelen);
13002a87bd73SDave Ertman
13012a87bd73SDave Ertman ouisubtype = (u32)((ICE_DSCP_OUI << ICE_LLDP_TLV_OUI_S) |
13022a87bd73SDave Ertman ICE_DSCP_SUBTYPE_DSCP2UP);
13032a87bd73SDave Ertman tlv->ouisubtype = htonl(ouisubtype);
13042a87bd73SDave Ertman
13052a87bd73SDave Ertman /* bytes 0 - 63 - IPv4 DSCP2UP LUT */
13062a87bd73SDave Ertman for (i = 0; i < ICE_DSCP_NUM_VAL; i++) {
13072a87bd73SDave Ertman /* IPv4 mapping */
13082a87bd73SDave Ertman buf[i] = dcbcfg->dscp_map[i];
13092a87bd73SDave Ertman /* IPv6 mapping */
13102a87bd73SDave Ertman buf[i + ICE_DSCP_IPV6_OFFSET] = dcbcfg->dscp_map[i];
13112a87bd73SDave Ertman }
13122a87bd73SDave Ertman
13132a87bd73SDave Ertman /* byte 64 - IPv4 untagged traffic */
13142a87bd73SDave Ertman buf[i] = 0;
13152a87bd73SDave Ertman
13162a87bd73SDave Ertman /* byte 144 - IPv6 untagged traffic */
13172a87bd73SDave Ertman buf[i + ICE_DSCP_IPV6_OFFSET] = 0;
13182a87bd73SDave Ertman }
13192a87bd73SDave Ertman
13202a87bd73SDave Ertman #define ICE_BYTES_PER_TC 8
13212a87bd73SDave Ertman /**
13222a87bd73SDave Ertman * ice_add_dscp_enf_tlv - Prepare DSCP Enforcement TLV
13232a87bd73SDave Ertman * @tlv: location to build the TLV data
13242a87bd73SDave Ertman */
13252a87bd73SDave Ertman static void
ice_add_dscp_enf_tlv(struct ice_lldp_org_tlv * tlv)13262a87bd73SDave Ertman ice_add_dscp_enf_tlv(struct ice_lldp_org_tlv *tlv)
13272a87bd73SDave Ertman {
13282a87bd73SDave Ertman u8 *buf = tlv->tlvinfo;
13292a87bd73SDave Ertman u32 ouisubtype;
13302a87bd73SDave Ertman u16 typelen;
13312a87bd73SDave Ertman
13322a87bd73SDave Ertman typelen = ((ICE_TLV_TYPE_ORG << ICE_LLDP_TLV_TYPE_S) |
13332a87bd73SDave Ertman ICE_DSCP_ENF_TLV_LEN);
13342a87bd73SDave Ertman tlv->typelen = htons(typelen);
13352a87bd73SDave Ertman
13362a87bd73SDave Ertman ouisubtype = (u32)((ICE_DSCP_OUI << ICE_LLDP_TLV_OUI_S) |
13372a87bd73SDave Ertman ICE_DSCP_SUBTYPE_ENFORCE);
13382a87bd73SDave Ertman tlv->ouisubtype = htonl(ouisubtype);
13392a87bd73SDave Ertman
13402a87bd73SDave Ertman /* Allow all DSCP values to be valid for all TC's (IPv4 and IPv6) */
13412a87bd73SDave Ertman memset(buf, 0, 2 * (ICE_MAX_TRAFFIC_CLASS * ICE_BYTES_PER_TC));
13422a87bd73SDave Ertman }
13432a87bd73SDave Ertman
13442a87bd73SDave Ertman /**
13452a87bd73SDave Ertman * ice_add_dscp_tc_bw_tlv - Prepare DSCP BW for TC TLV
13462a87bd73SDave Ertman * @tlv: location to build the TLV data
13472a87bd73SDave Ertman * @dcbcfg: location of the data to convert to TLV
13482a87bd73SDave Ertman */
13492a87bd73SDave Ertman static void
ice_add_dscp_tc_bw_tlv(struct ice_lldp_org_tlv * tlv,struct ice_dcbx_cfg * dcbcfg)13502a87bd73SDave Ertman ice_add_dscp_tc_bw_tlv(struct ice_lldp_org_tlv *tlv,
13512a87bd73SDave Ertman struct ice_dcbx_cfg *dcbcfg)
13522a87bd73SDave Ertman {
13532a87bd73SDave Ertman struct ice_dcb_ets_cfg *etscfg;
13542a87bd73SDave Ertman u8 *buf = tlv->tlvinfo;
13552a87bd73SDave Ertman u32 ouisubtype;
13562a87bd73SDave Ertman u8 offset = 0;
13572a87bd73SDave Ertman u16 typelen;
13582a87bd73SDave Ertman int i;
13592a87bd73SDave Ertman
13602a87bd73SDave Ertman typelen = ((ICE_TLV_TYPE_ORG << ICE_LLDP_TLV_TYPE_S) |
13612a87bd73SDave Ertman ICE_DSCP_TC_BW_TLV_LEN);
13622a87bd73SDave Ertman tlv->typelen = htons(typelen);
13632a87bd73SDave Ertman
13642a87bd73SDave Ertman ouisubtype = (u32)((ICE_DSCP_OUI << ICE_LLDP_TLV_OUI_S) |
13652a87bd73SDave Ertman ICE_DSCP_SUBTYPE_TCBW);
13662a87bd73SDave Ertman tlv->ouisubtype = htonl(ouisubtype);
13672a87bd73SDave Ertman
13682a87bd73SDave Ertman /* First Octect after subtype
13692a87bd73SDave Ertman * ----------------------------
13702a87bd73SDave Ertman * | RSV | CBS | RSV | Max TCs |
13712a87bd73SDave Ertman * | 1b | 1b | 3b | 3b |
13722a87bd73SDave Ertman * ----------------------------
13732a87bd73SDave Ertman */
13742a87bd73SDave Ertman etscfg = &dcbcfg->etscfg;
13752a87bd73SDave Ertman buf[0] = etscfg->maxtcs & ICE_IEEE_ETS_MAXTC_M;
13762a87bd73SDave Ertman
13772a87bd73SDave Ertman /* bytes 1 - 4 reserved */
13782a87bd73SDave Ertman offset = 5;
13792a87bd73SDave Ertman
13802a87bd73SDave Ertman /* TC BW table
13812a87bd73SDave Ertman * bytes 0 - 7 for TC 0 - 7
13822a87bd73SDave Ertman *
13832a87bd73SDave Ertman * TSA Assignment table
13842a87bd73SDave Ertman * bytes 8 - 15 for TC 0 - 7
13852a87bd73SDave Ertman */
13862a87bd73SDave Ertman for (i = 0; i < ICE_MAX_TRAFFIC_CLASS; i++) {
13872a87bd73SDave Ertman buf[offset] = etscfg->tcbwtable[i];
13882a87bd73SDave Ertman buf[offset + ICE_MAX_TRAFFIC_CLASS] = etscfg->tsatable[i];
13892a87bd73SDave Ertman offset++;
13902a87bd73SDave Ertman }
13912a87bd73SDave Ertman }
13922a87bd73SDave Ertman
13932a87bd73SDave Ertman /**
13942a87bd73SDave Ertman * ice_add_dscp_pfc_tlv - Prepare DSCP PFC TLV
13952a87bd73SDave Ertman * @tlv: Fill PFC TLV in IEEE format
13962a87bd73SDave Ertman * @dcbcfg: Local store which holds the PFC CFG data
13972a87bd73SDave Ertman */
13982a87bd73SDave Ertman static void
ice_add_dscp_pfc_tlv(struct ice_lldp_org_tlv * tlv,struct ice_dcbx_cfg * dcbcfg)13992a87bd73SDave Ertman ice_add_dscp_pfc_tlv(struct ice_lldp_org_tlv *tlv, struct ice_dcbx_cfg *dcbcfg)
14002a87bd73SDave Ertman {
14012a87bd73SDave Ertman u8 *buf = tlv->tlvinfo;
14022a87bd73SDave Ertman u32 ouisubtype;
14032a87bd73SDave Ertman u16 typelen;
14042a87bd73SDave Ertman
14052a87bd73SDave Ertman typelen = ((ICE_TLV_TYPE_ORG << ICE_LLDP_TLV_TYPE_S) |
14062a87bd73SDave Ertman ICE_DSCP_PFC_TLV_LEN);
14072a87bd73SDave Ertman tlv->typelen = htons(typelen);
14082a87bd73SDave Ertman
14092a87bd73SDave Ertman ouisubtype = (u32)((ICE_DSCP_OUI << ICE_LLDP_TLV_OUI_S) |
14102a87bd73SDave Ertman ICE_DSCP_SUBTYPE_PFC);
14112a87bd73SDave Ertman tlv->ouisubtype = htonl(ouisubtype);
14122a87bd73SDave Ertman
14132a87bd73SDave Ertman buf[0] = dcbcfg->pfc.pfccap & 0xF;
1414*fef3f92eSDave Ertman buf[1] = dcbcfg->pfc.pfcena;
14152a87bd73SDave Ertman }
14162a87bd73SDave Ertman
14172a87bd73SDave Ertman /**
14182a87bd73SDave Ertman * ice_add_dcb_tlv - Add all IEEE or DSCP TLVs
14197b9ffc76SAnirudh Venkataramanan * @tlv: Fill TLV data in IEEE format
14207b9ffc76SAnirudh Venkataramanan * @dcbcfg: Local store which holds the DCB Config
14217b9ffc76SAnirudh Venkataramanan * @tlvid: Type of IEEE TLV
14227b9ffc76SAnirudh Venkataramanan *
14237b9ffc76SAnirudh Venkataramanan * Add tlv information
14247b9ffc76SAnirudh Venkataramanan */
14257b9ffc76SAnirudh Venkataramanan static void
ice_add_dcb_tlv(struct ice_lldp_org_tlv * tlv,struct ice_dcbx_cfg * dcbcfg,u16 tlvid)14267b9ffc76SAnirudh Venkataramanan ice_add_dcb_tlv(struct ice_lldp_org_tlv *tlv, struct ice_dcbx_cfg *dcbcfg,
14277b9ffc76SAnirudh Venkataramanan u16 tlvid)
14287b9ffc76SAnirudh Venkataramanan {
14292a87bd73SDave Ertman if (dcbcfg->pfc_mode == ICE_QOS_MODE_VLAN) {
14307b9ffc76SAnirudh Venkataramanan switch (tlvid) {
14317b9ffc76SAnirudh Venkataramanan case ICE_IEEE_TLV_ID_ETS_CFG:
14327b9ffc76SAnirudh Venkataramanan ice_add_ieee_ets_tlv(tlv, dcbcfg);
14337b9ffc76SAnirudh Venkataramanan break;
14347b9ffc76SAnirudh Venkataramanan case ICE_IEEE_TLV_ID_ETS_REC:
14357b9ffc76SAnirudh Venkataramanan ice_add_ieee_etsrec_tlv(tlv, dcbcfg);
14367b9ffc76SAnirudh Venkataramanan break;
14377b9ffc76SAnirudh Venkataramanan case ICE_IEEE_TLV_ID_PFC_CFG:
14387b9ffc76SAnirudh Venkataramanan ice_add_ieee_pfc_tlv(tlv, dcbcfg);
14397b9ffc76SAnirudh Venkataramanan break;
14407b9ffc76SAnirudh Venkataramanan case ICE_IEEE_TLV_ID_APP_PRI:
14417b9ffc76SAnirudh Venkataramanan ice_add_ieee_app_pri_tlv(tlv, dcbcfg);
14427b9ffc76SAnirudh Venkataramanan break;
14437b9ffc76SAnirudh Venkataramanan default:
14447b9ffc76SAnirudh Venkataramanan break;
14457b9ffc76SAnirudh Venkataramanan }
14462a87bd73SDave Ertman } else {
14472a87bd73SDave Ertman /* pfc_mode == ICE_QOS_MODE_DSCP */
14482a87bd73SDave Ertman switch (tlvid) {
14492a87bd73SDave Ertman case ICE_TLV_ID_DSCP_UP:
14502a87bd73SDave Ertman ice_add_dscp_up_tlv(tlv, dcbcfg);
14512a87bd73SDave Ertman break;
14522a87bd73SDave Ertman case ICE_TLV_ID_DSCP_ENF:
14532a87bd73SDave Ertman ice_add_dscp_enf_tlv(tlv);
14542a87bd73SDave Ertman break;
14552a87bd73SDave Ertman case ICE_TLV_ID_DSCP_TC_BW:
14562a87bd73SDave Ertman ice_add_dscp_tc_bw_tlv(tlv, dcbcfg);
14572a87bd73SDave Ertman break;
14582a87bd73SDave Ertman case ICE_TLV_ID_DSCP_TO_PFC:
14592a87bd73SDave Ertman ice_add_dscp_pfc_tlv(tlv, dcbcfg);
14602a87bd73SDave Ertman break;
14612a87bd73SDave Ertman default:
14622a87bd73SDave Ertman break;
14632a87bd73SDave Ertman }
14642a87bd73SDave Ertman }
14657b9ffc76SAnirudh Venkataramanan }
14667b9ffc76SAnirudh Venkataramanan
14677b9ffc76SAnirudh Venkataramanan /**
14687b9ffc76SAnirudh Venkataramanan * ice_dcb_cfg_to_lldp - Convert DCB configuration to MIB format
14697b9ffc76SAnirudh Venkataramanan * @lldpmib: pointer to the HW struct
14707b9ffc76SAnirudh Venkataramanan * @miblen: length of LLDP MIB
14717b9ffc76SAnirudh Venkataramanan * @dcbcfg: Local store which holds the DCB Config
14727b9ffc76SAnirudh Venkataramanan *
14737b9ffc76SAnirudh Venkataramanan * Convert the DCB configuration to MIB format
14747b9ffc76SAnirudh Venkataramanan */
14757b9ffc76SAnirudh Venkataramanan static void
ice_dcb_cfg_to_lldp(u8 * lldpmib,u16 * miblen,struct ice_dcbx_cfg * dcbcfg)14767b9ffc76SAnirudh Venkataramanan ice_dcb_cfg_to_lldp(u8 *lldpmib, u16 *miblen, struct ice_dcbx_cfg *dcbcfg)
14777b9ffc76SAnirudh Venkataramanan {
14787b9ffc76SAnirudh Venkataramanan u16 len, offset = 0, tlvid = ICE_TLV_ID_START;
14797b9ffc76SAnirudh Venkataramanan struct ice_lldp_org_tlv *tlv;
14807b9ffc76SAnirudh Venkataramanan u16 typelen;
14817b9ffc76SAnirudh Venkataramanan
14827b9ffc76SAnirudh Venkataramanan tlv = (struct ice_lldp_org_tlv *)lldpmib;
14837b9ffc76SAnirudh Venkataramanan while (1) {
14847b9ffc76SAnirudh Venkataramanan ice_add_dcb_tlv(tlv, dcbcfg, tlvid++);
14857b9ffc76SAnirudh Venkataramanan typelen = ntohs(tlv->typelen);
14867b9ffc76SAnirudh Venkataramanan len = (typelen & ICE_LLDP_TLV_LEN_M) >> ICE_LLDP_TLV_LEN_S;
14877b9ffc76SAnirudh Venkataramanan if (len)
14887b9ffc76SAnirudh Venkataramanan offset += len + 2;
14897b9ffc76SAnirudh Venkataramanan /* END TLV or beyond LLDPDU size */
14907b9ffc76SAnirudh Venkataramanan if (tlvid >= ICE_TLV_ID_END_OF_LLDPPDU ||
14917b9ffc76SAnirudh Venkataramanan offset > ICE_LLDPDU_SIZE)
14927b9ffc76SAnirudh Venkataramanan break;
14937b9ffc76SAnirudh Venkataramanan /* Move to next TLV */
14947b9ffc76SAnirudh Venkataramanan if (len)
14957b9ffc76SAnirudh Venkataramanan tlv = (struct ice_lldp_org_tlv *)
14967b9ffc76SAnirudh Venkataramanan ((char *)tlv + sizeof(tlv->typelen) + len);
14977b9ffc76SAnirudh Venkataramanan }
14987b9ffc76SAnirudh Venkataramanan *miblen = offset;
14997b9ffc76SAnirudh Venkataramanan }
15007b9ffc76SAnirudh Venkataramanan
15017b9ffc76SAnirudh Venkataramanan /**
15027b9ffc76SAnirudh Venkataramanan * ice_set_dcb_cfg - Set the local LLDP MIB to FW
15037b9ffc76SAnirudh Venkataramanan * @pi: port information structure
15047b9ffc76SAnirudh Venkataramanan *
15057b9ffc76SAnirudh Venkataramanan * Set DCB configuration to the Firmware
15067b9ffc76SAnirudh Venkataramanan */
ice_set_dcb_cfg(struct ice_port_info * pi)15075e24d598STony Nguyen int ice_set_dcb_cfg(struct ice_port_info *pi)
15087b9ffc76SAnirudh Venkataramanan {
15097b9ffc76SAnirudh Venkataramanan u8 mib_type, *lldpmib = NULL;
15107b9ffc76SAnirudh Venkataramanan struct ice_dcbx_cfg *dcbcfg;
15117b9ffc76SAnirudh Venkataramanan struct ice_hw *hw;
15127b9ffc76SAnirudh Venkataramanan u16 miblen;
15135518ac2aSTony Nguyen int ret;
15147b9ffc76SAnirudh Venkataramanan
15157b9ffc76SAnirudh Venkataramanan if (!pi)
1516d54699e2STony Nguyen return -EINVAL;
15177b9ffc76SAnirudh Venkataramanan
15187b9ffc76SAnirudh Venkataramanan hw = pi->hw;
15197b9ffc76SAnirudh Venkataramanan
15207b9ffc76SAnirudh Venkataramanan /* update the HW local config */
1521fc2d1165SChinh T Cao dcbcfg = &pi->qos_cfg.local_dcbx_cfg;
15227b9ffc76SAnirudh Venkataramanan /* Allocate the LLDPDU */
15237b9ffc76SAnirudh Venkataramanan lldpmib = devm_kzalloc(ice_hw_to_dev(hw), ICE_LLDPDU_SIZE, GFP_KERNEL);
15247b9ffc76SAnirudh Venkataramanan if (!lldpmib)
1525d54699e2STony Nguyen return -ENOMEM;
15267b9ffc76SAnirudh Venkataramanan
15277b9ffc76SAnirudh Venkataramanan mib_type = SET_LOCAL_MIB_TYPE_LOCAL_MIB;
15287b9ffc76SAnirudh Venkataramanan if (dcbcfg->app_mode == ICE_DCBX_APPS_NON_WILLING)
15297b9ffc76SAnirudh Venkataramanan mib_type |= SET_LOCAL_MIB_TYPE_CEE_NON_WILLING;
15307b9ffc76SAnirudh Venkataramanan
15317b9ffc76SAnirudh Venkataramanan ice_dcb_cfg_to_lldp(lldpmib, &miblen, dcbcfg);
15327b9ffc76SAnirudh Venkataramanan ret = ice_aq_set_lldp_mib(hw, mib_type, (void *)lldpmib, miblen,
15337b9ffc76SAnirudh Venkataramanan NULL);
15347b9ffc76SAnirudh Venkataramanan
15357b9ffc76SAnirudh Venkataramanan devm_kfree(ice_hw_to_dev(hw), lldpmib);
15367b9ffc76SAnirudh Venkataramanan
15377b9ffc76SAnirudh Venkataramanan return ret;
15387b9ffc76SAnirudh Venkataramanan }
15397b9ffc76SAnirudh Venkataramanan
15407b9ffc76SAnirudh Venkataramanan /**
15414ee656bbSTony Nguyen * ice_aq_query_port_ets - query port ETS configuration
15427b9ffc76SAnirudh Venkataramanan * @pi: port information structure
15437b9ffc76SAnirudh Venkataramanan * @buf: pointer to buffer
15447b9ffc76SAnirudh Venkataramanan * @buf_size: buffer size in bytes
15457b9ffc76SAnirudh Venkataramanan * @cd: pointer to command details structure or NULL
15467b9ffc76SAnirudh Venkataramanan *
15474ee656bbSTony Nguyen * query current port ETS configuration
15487b9ffc76SAnirudh Venkataramanan */
15495e24d598STony Nguyen static int
ice_aq_query_port_ets(struct ice_port_info * pi,struct ice_aqc_port_ets_elem * buf,u16 buf_size,struct ice_sq_cd * cd)15507b9ffc76SAnirudh Venkataramanan ice_aq_query_port_ets(struct ice_port_info *pi,
15517b9ffc76SAnirudh Venkataramanan struct ice_aqc_port_ets_elem *buf, u16 buf_size,
15527b9ffc76SAnirudh Venkataramanan struct ice_sq_cd *cd)
15537b9ffc76SAnirudh Venkataramanan {
15547b9ffc76SAnirudh Venkataramanan struct ice_aqc_query_port_ets *cmd;
15557b9ffc76SAnirudh Venkataramanan struct ice_aq_desc desc;
15565e24d598STony Nguyen int status;
15577b9ffc76SAnirudh Venkataramanan
15587b9ffc76SAnirudh Venkataramanan if (!pi)
1559d54699e2STony Nguyen return -EINVAL;
15607b9ffc76SAnirudh Venkataramanan cmd = &desc.params.port_ets;
15617b9ffc76SAnirudh Venkataramanan ice_fill_dflt_direct_cmd_desc(&desc, ice_aqc_opc_query_port_ets);
15627b9ffc76SAnirudh Venkataramanan cmd->port_teid = pi->root->info.node_teid;
15637b9ffc76SAnirudh Venkataramanan
15647b9ffc76SAnirudh Venkataramanan status = ice_aq_send_cmd(pi->hw, &desc, buf, buf_size, cd);
15657b9ffc76SAnirudh Venkataramanan return status;
15667b9ffc76SAnirudh Venkataramanan }
15677b9ffc76SAnirudh Venkataramanan
15687b9ffc76SAnirudh Venkataramanan /**
15697b9ffc76SAnirudh Venkataramanan * ice_update_port_tc_tree_cfg - update TC tree configuration
15707b9ffc76SAnirudh Venkataramanan * @pi: port information structure
15717b9ffc76SAnirudh Venkataramanan * @buf: pointer to buffer
15727b9ffc76SAnirudh Venkataramanan *
15737b9ffc76SAnirudh Venkataramanan * update the SW DB with the new TC changes
15747b9ffc76SAnirudh Venkataramanan */
15755e24d598STony Nguyen static int
ice_update_port_tc_tree_cfg(struct ice_port_info * pi,struct ice_aqc_port_ets_elem * buf)15767b9ffc76SAnirudh Venkataramanan ice_update_port_tc_tree_cfg(struct ice_port_info *pi,
15777b9ffc76SAnirudh Venkataramanan struct ice_aqc_port_ets_elem *buf)
15787b9ffc76SAnirudh Venkataramanan {
15797b9ffc76SAnirudh Venkataramanan struct ice_sched_node *node, *tc_node;
1580b3c38904SBruce Allan struct ice_aqc_txsched_elem_data elem;
15817b9ffc76SAnirudh Venkataramanan u32 teid1, teid2;
15825518ac2aSTony Nguyen int status = 0;
15837b9ffc76SAnirudh Venkataramanan u8 i, j;
15847b9ffc76SAnirudh Venkataramanan
15857b9ffc76SAnirudh Venkataramanan if (!pi)
1586d54699e2STony Nguyen return -EINVAL;
15877b9ffc76SAnirudh Venkataramanan /* suspend the missing TC nodes */
15887b9ffc76SAnirudh Venkataramanan for (i = 0; i < pi->root->num_children; i++) {
15897b9ffc76SAnirudh Venkataramanan teid1 = le32_to_cpu(pi->root->children[i]->info.node_teid);
15907b9ffc76SAnirudh Venkataramanan ice_for_each_traffic_class(j) {
15917b9ffc76SAnirudh Venkataramanan teid2 = le32_to_cpu(buf->tc_node_teid[j]);
15927b9ffc76SAnirudh Venkataramanan if (teid1 == teid2)
15937b9ffc76SAnirudh Venkataramanan break;
15947b9ffc76SAnirudh Venkataramanan }
15957b9ffc76SAnirudh Venkataramanan if (j < ICE_MAX_TRAFFIC_CLASS)
15967b9ffc76SAnirudh Venkataramanan continue;
15977b9ffc76SAnirudh Venkataramanan /* TC is missing */
15987b9ffc76SAnirudh Venkataramanan pi->root->children[i]->in_use = false;
15997b9ffc76SAnirudh Venkataramanan }
16007b9ffc76SAnirudh Venkataramanan /* add the new TC nodes */
16017b9ffc76SAnirudh Venkataramanan ice_for_each_traffic_class(j) {
16027b9ffc76SAnirudh Venkataramanan teid2 = le32_to_cpu(buf->tc_node_teid[j]);
16037b9ffc76SAnirudh Venkataramanan if (teid2 == ICE_INVAL_TEID)
16047b9ffc76SAnirudh Venkataramanan continue;
16057b9ffc76SAnirudh Venkataramanan /* Is it already present in the tree ? */
16067b9ffc76SAnirudh Venkataramanan for (i = 0; i < pi->root->num_children; i++) {
16077b9ffc76SAnirudh Venkataramanan tc_node = pi->root->children[i];
16087b9ffc76SAnirudh Venkataramanan if (!tc_node)
16097b9ffc76SAnirudh Venkataramanan continue;
16107b9ffc76SAnirudh Venkataramanan teid1 = le32_to_cpu(tc_node->info.node_teid);
16117b9ffc76SAnirudh Venkataramanan if (teid1 == teid2) {
16127b9ffc76SAnirudh Venkataramanan tc_node->tc_num = j;
16137b9ffc76SAnirudh Venkataramanan tc_node->in_use = true;
16147b9ffc76SAnirudh Venkataramanan break;
16157b9ffc76SAnirudh Venkataramanan }
16167b9ffc76SAnirudh Venkataramanan }
16177b9ffc76SAnirudh Venkataramanan if (i < pi->root->num_children)
16187b9ffc76SAnirudh Venkataramanan continue;
16197b9ffc76SAnirudh Venkataramanan /* new TC */
16207b9ffc76SAnirudh Venkataramanan status = ice_sched_query_elem(pi->hw, teid2, &elem);
16217b9ffc76SAnirudh Venkataramanan if (!status)
1622bdf96d96SMichal Wilczynski status = ice_sched_add_node(pi, 1, &elem, NULL);
16237b9ffc76SAnirudh Venkataramanan if (status)
16247b9ffc76SAnirudh Venkataramanan break;
16257b9ffc76SAnirudh Venkataramanan /* update the TC number */
16267b9ffc76SAnirudh Venkataramanan node = ice_sched_find_node_by_teid(pi->root, teid2);
16277b9ffc76SAnirudh Venkataramanan if (node)
16287b9ffc76SAnirudh Venkataramanan node->tc_num = j;
16297b9ffc76SAnirudh Venkataramanan }
16307b9ffc76SAnirudh Venkataramanan return status;
16317b9ffc76SAnirudh Venkataramanan }
16327b9ffc76SAnirudh Venkataramanan
16337b9ffc76SAnirudh Venkataramanan /**
16344ee656bbSTony Nguyen * ice_query_port_ets - query port ETS configuration
16357b9ffc76SAnirudh Venkataramanan * @pi: port information structure
16367b9ffc76SAnirudh Venkataramanan * @buf: pointer to buffer
16377b9ffc76SAnirudh Venkataramanan * @buf_size: buffer size in bytes
16387b9ffc76SAnirudh Venkataramanan * @cd: pointer to command details structure or NULL
16397b9ffc76SAnirudh Venkataramanan *
16404ee656bbSTony Nguyen * query current port ETS configuration and update the
16417b9ffc76SAnirudh Venkataramanan * SW DB with the TC changes
16427b9ffc76SAnirudh Venkataramanan */
16435e24d598STony Nguyen int
ice_query_port_ets(struct ice_port_info * pi,struct ice_aqc_port_ets_elem * buf,u16 buf_size,struct ice_sq_cd * cd)16447b9ffc76SAnirudh Venkataramanan ice_query_port_ets(struct ice_port_info *pi,
16457b9ffc76SAnirudh Venkataramanan struct ice_aqc_port_ets_elem *buf, u16 buf_size,
16467b9ffc76SAnirudh Venkataramanan struct ice_sq_cd *cd)
16477b9ffc76SAnirudh Venkataramanan {
16485e24d598STony Nguyen int status;
16497b9ffc76SAnirudh Venkataramanan
16507b9ffc76SAnirudh Venkataramanan mutex_lock(&pi->sched_lock);
16517b9ffc76SAnirudh Venkataramanan status = ice_aq_query_port_ets(pi, buf, buf_size, cd);
16527b9ffc76SAnirudh Venkataramanan if (!status)
16537b9ffc76SAnirudh Venkataramanan status = ice_update_port_tc_tree_cfg(pi, buf);
16547b9ffc76SAnirudh Venkataramanan mutex_unlock(&pi->sched_lock);
16557b9ffc76SAnirudh Venkataramanan return status;
16567b9ffc76SAnirudh Venkataramanan }
1657