Commit | Line | Data |
---|---|---|
37b6f646 AV |
1 | // SPDX-License-Identifier: GPL-2.0 |
2 | /* Copyright (c) 2019, Intel Corporation. */ | |
3 | ||
4 | #include "ice_common.h" | |
5 | #include "ice_sched.h" | |
6 | #include "ice_dcb.h" | |
7 | ||
0ebd3ff1 AV |
8 | /** |
9 | * ice_aq_get_lldp_mib | |
10 | * @hw: pointer to the HW struct | |
11 | * @bridge_type: type of bridge requested | |
12 | * @mib_type: Local, Remote or both Local and Remote MIBs | |
13 | * @buf: pointer to the caller-supplied buffer to store the MIB block | |
14 | * @buf_size: size of the buffer (in bytes) | |
15 | * @local_len: length of the returned Local LLDP MIB | |
16 | * @remote_len: length of the returned Remote LLDP MIB | |
17 | * @cd: pointer to command details structure or NULL | |
18 | * | |
19 | * Requests the complete LLDP MIB (entire packet). (0x0A00) | |
20 | */ | |
5e24d598 | 21 | static int |
0ebd3ff1 AV |
22 | ice_aq_get_lldp_mib(struct ice_hw *hw, u8 bridge_type, u8 mib_type, void *buf, |
23 | u16 buf_size, u16 *local_len, u16 *remote_len, | |
24 | struct ice_sq_cd *cd) | |
25 | { | |
26 | struct ice_aqc_lldp_get_mib *cmd; | |
27 | struct ice_aq_desc desc; | |
5e24d598 | 28 | int status; |
0ebd3ff1 AV |
29 | |
30 | cmd = &desc.params.lldp_get_mib; | |
31 | ||
32 | if (buf_size == 0 || !buf) | |
d54699e2 | 33 | return -EINVAL; |
0ebd3ff1 AV |
34 | |
35 | ice_fill_dflt_direct_cmd_desc(&desc, ice_aqc_opc_lldp_get_mib); | |
36 | ||
37 | cmd->type = mib_type & ICE_AQ_LLDP_MIB_TYPE_M; | |
38 | cmd->type |= (bridge_type << ICE_AQ_LLDP_BRID_TYPE_S) & | |
39 | ICE_AQ_LLDP_BRID_TYPE_M; | |
40 | ||
41 | desc.datalen = cpu_to_le16(buf_size); | |
42 | ||
43 | status = ice_aq_send_cmd(hw, &desc, buf, buf_size, cd); | |
44 | if (!status) { | |
45 | if (local_len) | |
46 | *local_len = le16_to_cpu(cmd->local_len); | |
47 | if (remote_len) | |
48 | *remote_len = le16_to_cpu(cmd->remote_len); | |
49 | } | |
50 | ||
51 | return status; | |
52 | } | |
53 | ||
54 | /** | |
55 | * ice_aq_cfg_lldp_mib_change | |
56 | * @hw: pointer to the HW struct | |
57 | * @ena_update: Enable or Disable event posting | |
58 | * @cd: pointer to command details structure or NULL | |
59 | * | |
60 | * Enable or Disable posting of an event on ARQ when LLDP MIB | |
61 | * associated with the interface changes (0x0A01) | |
62 | */ | |
5e24d598 | 63 | static int |
0ebd3ff1 AV |
64 | ice_aq_cfg_lldp_mib_change(struct ice_hw *hw, bool ena_update, |
65 | struct ice_sq_cd *cd) | |
66 | { | |
67 | struct ice_aqc_lldp_set_mib_change *cmd; | |
68 | struct ice_aq_desc desc; | |
69 | ||
70 | cmd = &desc.params.lldp_set_event; | |
71 | ||
72 | ice_fill_dflt_direct_cmd_desc(&desc, ice_aqc_opc_lldp_set_mib_change); | |
73 | ||
74 | if (!ena_update) | |
75 | cmd->command |= ICE_AQ_LLDP_MIB_UPDATE_DIS; | |
76 | ||
77 | return ice_aq_send_cmd(hw, &desc, NULL, 0, cd); | |
3a257a14 AV |
78 | } |
79 | ||
80 | /** | |
81 | * ice_aq_stop_lldp | |
82 | * @hw: pointer to the HW struct | |
83 | * @shutdown_lldp_agent: True if LLDP Agent needs to be Shutdown | |
84 | * False if LLDP Agent needs to be Stopped | |
31eafa40 AV |
85 | * @persist: True if Stop/Shutdown of LLDP Agent needs to be persistent across |
86 | * reboots | |
3a257a14 AV |
87 | * @cd: pointer to command details structure or NULL |
88 | * | |
89 | * Stop or Shutdown the embedded LLDP Agent (0x0A05) | |
90 | */ | |
5e24d598 | 91 | int |
31eafa40 | 92 | ice_aq_stop_lldp(struct ice_hw *hw, bool shutdown_lldp_agent, bool persist, |
3a257a14 AV |
93 | struct ice_sq_cd *cd) |
94 | { | |
95 | struct ice_aqc_lldp_stop *cmd; | |
96 | struct ice_aq_desc desc; | |
97 | ||
98 | cmd = &desc.params.lldp_stop; | |
99 | ||
100 | ice_fill_dflt_direct_cmd_desc(&desc, ice_aqc_opc_lldp_stop); | |
101 | ||
102 | if (shutdown_lldp_agent) | |
103 | cmd->command |= ICE_AQ_LLDP_AGENT_SHUTDOWN; | |
104 | ||
31eafa40 AV |
105 | if (persist) |
106 | cmd->command |= ICE_AQ_LLDP_AGENT_PERSIST_DIS; | |
107 | ||
3a257a14 | 108 | return ice_aq_send_cmd(hw, &desc, NULL, 0, cd); |
0ebd3ff1 AV |
109 | } |
110 | ||
37b6f646 AV |
111 | /** |
112 | * ice_aq_start_lldp | |
113 | * @hw: pointer to the HW struct | |
31eafa40 | 114 | * @persist: True if Start of LLDP Agent needs to be persistent across reboots |
37b6f646 AV |
115 | * @cd: pointer to command details structure or NULL |
116 | * | |
117 | * Start the embedded LLDP Agent on all ports. (0x0A06) | |
118 | */ | |
5518ac2a | 119 | int ice_aq_start_lldp(struct ice_hw *hw, bool persist, struct ice_sq_cd *cd) |
37b6f646 AV |
120 | { |
121 | struct ice_aqc_lldp_start *cmd; | |
122 | struct ice_aq_desc desc; | |
123 | ||
124 | cmd = &desc.params.lldp_start; | |
125 | ||
126 | ice_fill_dflt_direct_cmd_desc(&desc, ice_aqc_opc_lldp_start); | |
127 | ||
128 | cmd->command = ICE_AQ_LLDP_AGENT_START; | |
129 | ||
31eafa40 AV |
130 | if (persist) |
131 | cmd->command |= ICE_AQ_LLDP_AGENT_PERSIST_ENA; | |
132 | ||
37b6f646 AV |
133 | return ice_aq_send_cmd(hw, &desc, NULL, 0, cd); |
134 | } | |
135 | ||
136 | /** | |
137 | * ice_get_dcbx_status | |
138 | * @hw: pointer to the HW struct | |
139 | * | |
140 | * Get the DCBX status from the Firmware | |
141 | */ | |
31eafa40 | 142 | static u8 ice_get_dcbx_status(struct ice_hw *hw) |
37b6f646 AV |
143 | { |
144 | u32 reg; | |
145 | ||
146 | reg = rd32(hw, PRTDCB_GENS); | |
147 | return (u8)((reg & PRTDCB_GENS_DCBX_STATUS_M) >> | |
148 | PRTDCB_GENS_DCBX_STATUS_S); | |
149 | } | |
150 | ||
0ebd3ff1 AV |
151 | /** |
152 | * ice_parse_ieee_ets_common_tlv | |
153 | * @buf: Data buffer to be parsed for ETS CFG/REC data | |
154 | * @ets_cfg: Container to store parsed data | |
155 | * | |
156 | * Parses the common data of IEEE 802.1Qaz ETS CFG/REC TLV | |
157 | */ | |
158 | static void | |
159 | ice_parse_ieee_ets_common_tlv(u8 *buf, struct ice_dcb_ets_cfg *ets_cfg) | |
160 | { | |
161 | u8 offset = 0; | |
162 | int i; | |
163 | ||
164 | /* Priority Assignment Table (4 octets) | |
165 | * Octets:| 1 | 2 | 3 | 4 | | |
166 | * ----------------------------------------- | |
167 | * |pri0|pri1|pri2|pri3|pri4|pri5|pri6|pri7| | |
168 | * ----------------------------------------- | |
169 | * Bits:|7 4|3 0|7 4|3 0|7 4|3 0|7 4|3 0| | |
170 | * ----------------------------------------- | |
171 | */ | |
172 | for (i = 0; i < 4; i++) { | |
173 | ets_cfg->prio_table[i * 2] = | |
174 | ((buf[offset] & ICE_IEEE_ETS_PRIO_1_M) >> | |
175 | ICE_IEEE_ETS_PRIO_1_S); | |
176 | ets_cfg->prio_table[i * 2 + 1] = | |
177 | ((buf[offset] & ICE_IEEE_ETS_PRIO_0_M) >> | |
178 | ICE_IEEE_ETS_PRIO_0_S); | |
179 | offset++; | |
180 | } | |
181 | ||
182 | /* TC Bandwidth Table (8 octets) | |
183 | * Octets:| 1 | 2 | 3 | 4 | 5 | 6 | 7 | 8 | | |
184 | * --------------------------------- | |
185 | * |tc0|tc1|tc2|tc3|tc4|tc5|tc6|tc7| | |
186 | * --------------------------------- | |
187 | * | |
188 | * TSA Assignment Table (8 octets) | |
189 | * Octets:| 9 | 10| 11| 12| 13| 14| 15| 16| | |
190 | * --------------------------------- | |
191 | * |tc0|tc1|tc2|tc3|tc4|tc5|tc6|tc7| | |
192 | * --------------------------------- | |
193 | */ | |
194 | ice_for_each_traffic_class(i) { | |
195 | ets_cfg->tcbwtable[i] = buf[offset]; | |
196 | ets_cfg->tsatable[i] = buf[ICE_MAX_TRAFFIC_CLASS + offset++]; | |
197 | } | |
198 | } | |
199 | ||
200 | /** | |
201 | * ice_parse_ieee_etscfg_tlv | |
202 | * @tlv: IEEE 802.1Qaz ETS CFG TLV | |
203 | * @dcbcfg: Local store to update ETS CFG data | |
204 | * | |
205 | * Parses IEEE 802.1Qaz ETS CFG TLV | |
206 | */ | |
207 | static void | |
208 | ice_parse_ieee_etscfg_tlv(struct ice_lldp_org_tlv *tlv, | |
209 | struct ice_dcbx_cfg *dcbcfg) | |
210 | { | |
211 | struct ice_dcb_ets_cfg *etscfg; | |
212 | u8 *buf = tlv->tlvinfo; | |
213 | ||
214 | /* First Octet post subtype | |
215 | * -------------------------- | |
216 | * |will-|CBS | Re- | Max | | |
217 | * |ing | |served| TCs | | |
218 | * -------------------------- | |
219 | * |1bit | 1bit|3 bits|3bits| | |
220 | */ | |
221 | etscfg = &dcbcfg->etscfg; | |
222 | etscfg->willing = ((buf[0] & ICE_IEEE_ETS_WILLING_M) >> | |
223 | ICE_IEEE_ETS_WILLING_S); | |
224 | etscfg->cbs = ((buf[0] & ICE_IEEE_ETS_CBS_M) >> ICE_IEEE_ETS_CBS_S); | |
225 | etscfg->maxtcs = ((buf[0] & ICE_IEEE_ETS_MAXTC_M) >> | |
226 | ICE_IEEE_ETS_MAXTC_S); | |
227 | ||
228 | /* Begin parsing at Priority Assignment Table (offset 1 in buf) */ | |
229 | ice_parse_ieee_ets_common_tlv(&buf[1], etscfg); | |
230 | } | |
231 | ||
232 | /** | |
233 | * ice_parse_ieee_etsrec_tlv | |
234 | * @tlv: IEEE 802.1Qaz ETS REC TLV | |
235 | * @dcbcfg: Local store to update ETS REC data | |
236 | * | |
237 | * Parses IEEE 802.1Qaz ETS REC TLV | |
238 | */ | |
239 | static void | |
240 | ice_parse_ieee_etsrec_tlv(struct ice_lldp_org_tlv *tlv, | |
241 | struct ice_dcbx_cfg *dcbcfg) | |
242 | { | |
243 | u8 *buf = tlv->tlvinfo; | |
244 | ||
245 | /* Begin parsing at Priority Assignment Table (offset 1 in buf) */ | |
246 | ice_parse_ieee_ets_common_tlv(&buf[1], &dcbcfg->etsrec); | |
247 | } | |
248 | ||
249 | /** | |
250 | * ice_parse_ieee_pfccfg_tlv | |
251 | * @tlv: IEEE 802.1Qaz PFC CFG TLV | |
252 | * @dcbcfg: Local store to update PFC CFG data | |
253 | * | |
254 | * Parses IEEE 802.1Qaz PFC CFG TLV | |
255 | */ | |
256 | static void | |
257 | ice_parse_ieee_pfccfg_tlv(struct ice_lldp_org_tlv *tlv, | |
258 | struct ice_dcbx_cfg *dcbcfg) | |
259 | { | |
260 | u8 *buf = tlv->tlvinfo; | |
261 | ||
262 | /* ---------------------------------------- | |
263 | * |will-|MBC | Re- | PFC | PFC Enable | | |
264 | * |ing | |served| cap | | | |
265 | * ----------------------------------------- | |
266 | * |1bit | 1bit|2 bits|4bits| 1 octet | | |
267 | */ | |
268 | dcbcfg->pfc.willing = ((buf[0] & ICE_IEEE_PFC_WILLING_M) >> | |
269 | ICE_IEEE_PFC_WILLING_S); | |
270 | dcbcfg->pfc.mbc = ((buf[0] & ICE_IEEE_PFC_MBC_M) >> ICE_IEEE_PFC_MBC_S); | |
271 | dcbcfg->pfc.pfccap = ((buf[0] & ICE_IEEE_PFC_CAP_M) >> | |
272 | ICE_IEEE_PFC_CAP_S); | |
273 | dcbcfg->pfc.pfcena = buf[1]; | |
274 | } | |
275 | ||
276 | /** | |
277 | * ice_parse_ieee_app_tlv | |
278 | * @tlv: IEEE 802.1Qaz APP TLV | |
279 | * @dcbcfg: Local store to update APP PRIO data | |
280 | * | |
281 | * Parses IEEE 802.1Qaz APP PRIO TLV | |
282 | */ | |
283 | static void | |
284 | ice_parse_ieee_app_tlv(struct ice_lldp_org_tlv *tlv, | |
285 | struct ice_dcbx_cfg *dcbcfg) | |
286 | { | |
287 | u16 offset = 0; | |
288 | u16 typelen; | |
289 | int i = 0; | |
290 | u16 len; | |
291 | u8 *buf; | |
292 | ||
293 | typelen = ntohs(tlv->typelen); | |
294 | len = ((typelen & ICE_LLDP_TLV_LEN_M) >> ICE_LLDP_TLV_LEN_S); | |
295 | buf = tlv->tlvinfo; | |
296 | ||
297 | /* Removing sizeof(ouisubtype) and reserved byte from len. | |
298 | * Remaining len div 3 is number of APP TLVs. | |
299 | */ | |
300 | len -= (sizeof(tlv->ouisubtype) + 1); | |
301 | ||
302 | /* Move offset to App Priority Table */ | |
303 | offset++; | |
304 | ||
305 | /* Application Priority Table (3 octets) | |
306 | * Octets:| 1 | 2 | 3 | | |
307 | * ----------------------------------------- | |
308 | * |Priority|Rsrvd| Sel | Protocol ID | | |
309 | * ----------------------------------------- | |
310 | * Bits:|23 21|20 19|18 16|15 0| | |
311 | * ----------------------------------------- | |
312 | */ | |
313 | while (offset < len) { | |
314 | dcbcfg->app[i].priority = ((buf[offset] & | |
315 | ICE_IEEE_APP_PRIO_M) >> | |
316 | ICE_IEEE_APP_PRIO_S); | |
317 | dcbcfg->app[i].selector = ((buf[offset] & | |
318 | ICE_IEEE_APP_SEL_M) >> | |
319 | ICE_IEEE_APP_SEL_S); | |
320 | dcbcfg->app[i].prot_id = (buf[offset + 1] << 0x8) | | |
321 | buf[offset + 2]; | |
322 | /* Move to next app */ | |
323 | offset += 3; | |
324 | i++; | |
325 | if (i >= ICE_DCBX_MAX_APPS) | |
326 | break; | |
327 | } | |
328 | ||
329 | dcbcfg->numapps = i; | |
330 | } | |
331 | ||
332 | /** | |
333 | * ice_parse_ieee_tlv | |
334 | * @tlv: IEEE 802.1Qaz TLV | |
335 | * @dcbcfg: Local store to update ETS REC data | |
336 | * | |
337 | * Get the TLV subtype and send it to parsing function | |
338 | * based on the subtype value | |
339 | */ | |
340 | static void | |
341 | ice_parse_ieee_tlv(struct ice_lldp_org_tlv *tlv, struct ice_dcbx_cfg *dcbcfg) | |
342 | { | |
343 | u32 ouisubtype; | |
344 | u8 subtype; | |
345 | ||
346 | ouisubtype = ntohl(tlv->ouisubtype); | |
347 | subtype = (u8)((ouisubtype & ICE_LLDP_TLV_SUBTYPE_M) >> | |
348 | ICE_LLDP_TLV_SUBTYPE_S); | |
349 | switch (subtype) { | |
350 | case ICE_IEEE_SUBTYPE_ETS_CFG: | |
351 | ice_parse_ieee_etscfg_tlv(tlv, dcbcfg); | |
352 | break; | |
353 | case ICE_IEEE_SUBTYPE_ETS_REC: | |
354 | ice_parse_ieee_etsrec_tlv(tlv, dcbcfg); | |
355 | break; | |
356 | case ICE_IEEE_SUBTYPE_PFC_CFG: | |
357 | ice_parse_ieee_pfccfg_tlv(tlv, dcbcfg); | |
358 | break; | |
359 | case ICE_IEEE_SUBTYPE_APP_PRI: | |
360 | ice_parse_ieee_app_tlv(tlv, dcbcfg); | |
361 | break; | |
362 | default: | |
363 | break; | |
364 | } | |
365 | } | |
366 | ||
367 | /** | |
368 | * ice_parse_cee_pgcfg_tlv | |
369 | * @tlv: CEE DCBX PG CFG TLV | |
370 | * @dcbcfg: Local store to update ETS CFG data | |
371 | * | |
372 | * Parses CEE DCBX PG CFG TLV | |
373 | */ | |
374 | static void | |
375 | ice_parse_cee_pgcfg_tlv(struct ice_cee_feat_tlv *tlv, | |
376 | struct ice_dcbx_cfg *dcbcfg) | |
377 | { | |
378 | struct ice_dcb_ets_cfg *etscfg; | |
379 | u8 *buf = tlv->tlvinfo; | |
380 | u16 offset = 0; | |
381 | int i; | |
382 | ||
383 | etscfg = &dcbcfg->etscfg; | |
384 | ||
385 | if (tlv->en_will_err & ICE_CEE_FEAT_TLV_WILLING_M) | |
386 | etscfg->willing = 1; | |
387 | ||
388 | etscfg->cbs = 0; | |
389 | /* Priority Group Table (4 octets) | |
390 | * Octets:| 1 | 2 | 3 | 4 | | |
391 | * ----------------------------------------- | |
392 | * |pri0|pri1|pri2|pri3|pri4|pri5|pri6|pri7| | |
393 | * ----------------------------------------- | |
394 | * Bits:|7 4|3 0|7 4|3 0|7 4|3 0|7 4|3 0| | |
395 | * ----------------------------------------- | |
396 | */ | |
397 | for (i = 0; i < 4; i++) { | |
398 | etscfg->prio_table[i * 2] = | |
399 | ((buf[offset] & ICE_CEE_PGID_PRIO_1_M) >> | |
400 | ICE_CEE_PGID_PRIO_1_S); | |
401 | etscfg->prio_table[i * 2 + 1] = | |
402 | ((buf[offset] & ICE_CEE_PGID_PRIO_0_M) >> | |
403 | ICE_CEE_PGID_PRIO_0_S); | |
404 | offset++; | |
405 | } | |
406 | ||
407 | /* PG Percentage Table (8 octets) | |
408 | * Octets:| 1 | 2 | 3 | 4 | 5 | 6 | 7 | 8 | | |
409 | * --------------------------------- | |
410 | * |pg0|pg1|pg2|pg3|pg4|pg5|pg6|pg7| | |
411 | * --------------------------------- | |
412 | */ | |
d24ef08a | 413 | ice_for_each_traffic_class(i) { |
0ebd3ff1 AV |
414 | etscfg->tcbwtable[i] = buf[offset++]; |
415 | ||
d24ef08a CC |
416 | if (etscfg->prio_table[i] == ICE_CEE_PGID_STRICT) |
417 | dcbcfg->etscfg.tsatable[i] = ICE_IEEE_TSA_STRICT; | |
418 | else | |
419 | dcbcfg->etscfg.tsatable[i] = ICE_IEEE_TSA_ETS; | |
420 | } | |
421 | ||
0ebd3ff1 AV |
422 | /* Number of TCs supported (1 octet) */ |
423 | etscfg->maxtcs = buf[offset]; | |
424 | } | |
425 | ||
426 | /** | |
427 | * ice_parse_cee_pfccfg_tlv | |
428 | * @tlv: CEE DCBX PFC CFG TLV | |
429 | * @dcbcfg: Local store to update PFC CFG data | |
430 | * | |
431 | * Parses CEE DCBX PFC CFG TLV | |
432 | */ | |
433 | static void | |
434 | ice_parse_cee_pfccfg_tlv(struct ice_cee_feat_tlv *tlv, | |
435 | struct ice_dcbx_cfg *dcbcfg) | |
436 | { | |
437 | u8 *buf = tlv->tlvinfo; | |
438 | ||
439 | if (tlv->en_will_err & ICE_CEE_FEAT_TLV_WILLING_M) | |
440 | dcbcfg->pfc.willing = 1; | |
441 | ||
442 | /* ------------------------ | |
443 | * | PFC Enable | PFC TCs | | |
444 | * ------------------------ | |
445 | * | 1 octet | 1 octet | | |
446 | */ | |
447 | dcbcfg->pfc.pfcena = buf[0]; | |
448 | dcbcfg->pfc.pfccap = buf[1]; | |
449 | } | |
450 | ||
451 | /** | |
452 | * ice_parse_cee_app_tlv | |
453 | * @tlv: CEE DCBX APP TLV | |
454 | * @dcbcfg: Local store to update APP PRIO data | |
455 | * | |
456 | * Parses CEE DCBX APP PRIO TLV | |
457 | */ | |
458 | static void | |
459 | ice_parse_cee_app_tlv(struct ice_cee_feat_tlv *tlv, struct ice_dcbx_cfg *dcbcfg) | |
460 | { | |
461 | u16 len, typelen, offset = 0; | |
462 | struct ice_cee_app_prio *app; | |
463 | u8 i; | |
464 | ||
465 | typelen = ntohs(tlv->hdr.typelen); | |
466 | len = ((typelen & ICE_LLDP_TLV_LEN_M) >> ICE_LLDP_TLV_LEN_S); | |
467 | ||
468 | dcbcfg->numapps = len / sizeof(*app); | |
469 | if (!dcbcfg->numapps) | |
470 | return; | |
471 | if (dcbcfg->numapps > ICE_DCBX_MAX_APPS) | |
472 | dcbcfg->numapps = ICE_DCBX_MAX_APPS; | |
473 | ||
474 | for (i = 0; i < dcbcfg->numapps; i++) { | |
475 | u8 up, selector; | |
476 | ||
477 | app = (struct ice_cee_app_prio *)(tlv->tlvinfo + offset); | |
478 | for (up = 0; up < ICE_MAX_USER_PRIORITY; up++) | |
479 | if (app->prio_map & BIT(up)) | |
480 | break; | |
481 | ||
482 | dcbcfg->app[i].priority = up; | |
483 | ||
484 | /* Get Selector from lower 2 bits, and convert to IEEE */ | |
485 | selector = (app->upper_oui_sel & ICE_CEE_APP_SELECTOR_M); | |
486 | switch (selector) { | |
487 | case ICE_CEE_APP_SEL_ETHTYPE: | |
488 | dcbcfg->app[i].selector = ICE_APP_SEL_ETHTYPE; | |
489 | break; | |
490 | case ICE_CEE_APP_SEL_TCPIP: | |
491 | dcbcfg->app[i].selector = ICE_APP_SEL_TCPIP; | |
492 | break; | |
493 | default: | |
494 | /* Keep selector as it is for unknown types */ | |
495 | dcbcfg->app[i].selector = selector; | |
496 | } | |
497 | ||
498 | dcbcfg->app[i].prot_id = ntohs(app->protocol); | |
499 | /* Move to next app */ | |
500 | offset += sizeof(*app); | |
501 | } | |
502 | } | |
503 | ||
504 | /** | |
505 | * ice_parse_cee_tlv | |
506 | * @tlv: CEE DCBX TLV | |
507 | * @dcbcfg: Local store to update DCBX config data | |
508 | * | |
509 | * Get the TLV subtype and send it to parsing function | |
510 | * based on the subtype value | |
511 | */ | |
512 | static void | |
513 | ice_parse_cee_tlv(struct ice_lldp_org_tlv *tlv, struct ice_dcbx_cfg *dcbcfg) | |
514 | { | |
515 | struct ice_cee_feat_tlv *sub_tlv; | |
516 | u8 subtype, feat_tlv_count = 0; | |
517 | u16 len, tlvlen, typelen; | |
518 | u32 ouisubtype; | |
519 | ||
520 | ouisubtype = ntohl(tlv->ouisubtype); | |
521 | subtype = (u8)((ouisubtype & ICE_LLDP_TLV_SUBTYPE_M) >> | |
522 | ICE_LLDP_TLV_SUBTYPE_S); | |
523 | /* Return if not CEE DCBX */ | |
524 | if (subtype != ICE_CEE_DCBX_TYPE) | |
525 | return; | |
526 | ||
527 | typelen = ntohs(tlv->typelen); | |
528 | tlvlen = ((typelen & ICE_LLDP_TLV_LEN_M) >> ICE_LLDP_TLV_LEN_S); | |
529 | len = sizeof(tlv->typelen) + sizeof(ouisubtype) + | |
530 | sizeof(struct ice_cee_ctrl_tlv); | |
531 | /* Return if no CEE DCBX Feature TLVs */ | |
532 | if (tlvlen <= len) | |
533 | return; | |
534 | ||
535 | sub_tlv = (struct ice_cee_feat_tlv *)((char *)tlv + len); | |
536 | while (feat_tlv_count < ICE_CEE_MAX_FEAT_TYPE) { | |
537 | u16 sublen; | |
538 | ||
539 | typelen = ntohs(sub_tlv->hdr.typelen); | |
540 | sublen = ((typelen & ICE_LLDP_TLV_LEN_M) >> ICE_LLDP_TLV_LEN_S); | |
541 | subtype = (u8)((typelen & ICE_LLDP_TLV_TYPE_M) >> | |
542 | ICE_LLDP_TLV_TYPE_S); | |
543 | switch (subtype) { | |
544 | case ICE_CEE_SUBTYPE_PG_CFG: | |
545 | ice_parse_cee_pgcfg_tlv(sub_tlv, dcbcfg); | |
546 | break; | |
547 | case ICE_CEE_SUBTYPE_PFC_CFG: | |
548 | ice_parse_cee_pfccfg_tlv(sub_tlv, dcbcfg); | |
549 | break; | |
550 | case ICE_CEE_SUBTYPE_APP_PRI: | |
551 | ice_parse_cee_app_tlv(sub_tlv, dcbcfg); | |
552 | break; | |
553 | default: | |
554 | return; /* Invalid Sub-type return */ | |
555 | } | |
556 | feat_tlv_count++; | |
557 | /* Move to next sub TLV */ | |
558 | sub_tlv = (struct ice_cee_feat_tlv *) | |
559 | ((char *)sub_tlv + sizeof(sub_tlv->hdr.typelen) + | |
560 | sublen); | |
561 | } | |
562 | } | |
563 | ||
564 | /** | |
565 | * ice_parse_org_tlv | |
566 | * @tlv: Organization specific TLV | |
567 | * @dcbcfg: Local store to update ETS REC data | |
568 | * | |
569 | * Currently only IEEE 802.1Qaz TLV is supported, all others | |
570 | * will be returned | |
571 | */ | |
572 | static void | |
573 | ice_parse_org_tlv(struct ice_lldp_org_tlv *tlv, struct ice_dcbx_cfg *dcbcfg) | |
574 | { | |
575 | u32 ouisubtype; | |
576 | u32 oui; | |
577 | ||
578 | ouisubtype = ntohl(tlv->ouisubtype); | |
579 | oui = ((ouisubtype & ICE_LLDP_TLV_OUI_M) >> ICE_LLDP_TLV_OUI_S); | |
580 | switch (oui) { | |
581 | case ICE_IEEE_8021QAZ_OUI: | |
582 | ice_parse_ieee_tlv(tlv, dcbcfg); | |
583 | break; | |
584 | case ICE_CEE_DCBX_OUI: | |
585 | ice_parse_cee_tlv(tlv, dcbcfg); | |
586 | break; | |
587 | default: | |
588 | break; | |
589 | } | |
590 | } | |
591 | ||
592 | /** | |
593 | * ice_lldp_to_dcb_cfg | |
594 | * @lldpmib: LLDPDU to be parsed | |
595 | * @dcbcfg: store for LLDPDU data | |
596 | * | |
597 | * Parse DCB configuration from the LLDPDU | |
598 | */ | |
5518ac2a | 599 | static int ice_lldp_to_dcb_cfg(u8 *lldpmib, struct ice_dcbx_cfg *dcbcfg) |
0ebd3ff1 AV |
600 | { |
601 | struct ice_lldp_org_tlv *tlv; | |
0ebd3ff1 | 602 | u16 offset = 0; |
5518ac2a | 603 | int ret = 0; |
0ebd3ff1 AV |
604 | u16 typelen; |
605 | u16 type; | |
606 | u16 len; | |
607 | ||
608 | if (!lldpmib || !dcbcfg) | |
d54699e2 | 609 | return -EINVAL; |
0ebd3ff1 AV |
610 | |
611 | /* set to the start of LLDPDU */ | |
612 | lldpmib += ETH_HLEN; | |
613 | tlv = (struct ice_lldp_org_tlv *)lldpmib; | |
614 | while (1) { | |
615 | typelen = ntohs(tlv->typelen); | |
616 | type = ((typelen & ICE_LLDP_TLV_TYPE_M) >> ICE_LLDP_TLV_TYPE_S); | |
617 | len = ((typelen & ICE_LLDP_TLV_LEN_M) >> ICE_LLDP_TLV_LEN_S); | |
618 | offset += sizeof(typelen) + len; | |
619 | ||
620 | /* END TLV or beyond LLDPDU size */ | |
621 | if (type == ICE_TLV_TYPE_END || offset > ICE_LLDPDU_SIZE) | |
622 | break; | |
623 | ||
624 | switch (type) { | |
625 | case ICE_TLV_TYPE_ORG: | |
626 | ice_parse_org_tlv(tlv, dcbcfg); | |
627 | break; | |
628 | default: | |
629 | break; | |
630 | } | |
631 | ||
632 | /* Move to next TLV */ | |
633 | tlv = (struct ice_lldp_org_tlv *) | |
634 | ((char *)tlv + sizeof(tlv->typelen) + len); | |
635 | } | |
636 | ||
637 | return ret; | |
638 | } | |
639 | ||
640 | /** | |
641 | * ice_aq_get_dcb_cfg | |
642 | * @hw: pointer to the HW struct | |
2f2da36e | 643 | * @mib_type: MIB type for the query |
0ebd3ff1 AV |
644 | * @bridgetype: bridge type for the query (remote) |
645 | * @dcbcfg: store for LLDPDU data | |
646 | * | |
647 | * Query DCB configuration from the firmware | |
648 | */ | |
5e24d598 | 649 | int |
0ebd3ff1 AV |
650 | ice_aq_get_dcb_cfg(struct ice_hw *hw, u8 mib_type, u8 bridgetype, |
651 | struct ice_dcbx_cfg *dcbcfg) | |
652 | { | |
0ebd3ff1 | 653 | u8 *lldpmib; |
5518ac2a | 654 | int ret; |
0ebd3ff1 AV |
655 | |
656 | /* Allocate the LLDPDU */ | |
657 | lldpmib = devm_kzalloc(ice_hw_to_dev(hw), ICE_LLDPDU_SIZE, GFP_KERNEL); | |
658 | if (!lldpmib) | |
d54699e2 | 659 | return -ENOMEM; |
0ebd3ff1 AV |
660 | |
661 | ret = ice_aq_get_lldp_mib(hw, bridgetype, mib_type, (void *)lldpmib, | |
662 | ICE_LLDPDU_SIZE, NULL, NULL, NULL); | |
663 | ||
664 | if (!ret) | |
665 | /* Parse LLDP MIB to get DCB configuration */ | |
666 | ret = ice_lldp_to_dcb_cfg(lldpmib, dcbcfg); | |
667 | ||
668 | devm_kfree(ice_hw_to_dev(hw), lldpmib); | |
669 | ||
670 | return ret; | |
671 | } | |
672 | ||
37b6f646 | 673 | /** |
2f2da36e | 674 | * ice_aq_start_stop_dcbx - Start/Stop DCBX service in FW |
37b6f646 | 675 | * @hw: pointer to the HW struct |
2f2da36e AV |
676 | * @start_dcbx_agent: True if DCBX Agent needs to be started |
677 | * False if DCBX Agent needs to be stopped | |
678 | * @dcbx_agent_status: FW indicates back the DCBX agent status | |
679 | * True if DCBX Agent is active | |
680 | * False if DCBX Agent is stopped | |
37b6f646 AV |
681 | * @cd: pointer to command details structure or NULL |
682 | * | |
683 | * Start/Stop the embedded dcbx Agent. In case that this wrapper function | |
d54699e2 | 684 | * returns 0, caller will need to check if FW returns back the same |
37b6f646 AV |
685 | * value as stated in dcbx_agent_status, and react accordingly. (0x0A09) |
686 | */ | |
5e24d598 | 687 | int |
37b6f646 AV |
688 | ice_aq_start_stop_dcbx(struct ice_hw *hw, bool start_dcbx_agent, |
689 | bool *dcbx_agent_status, struct ice_sq_cd *cd) | |
690 | { | |
691 | struct ice_aqc_lldp_stop_start_specific_agent *cmd; | |
37b6f646 AV |
692 | struct ice_aq_desc desc; |
693 | u16 opcode; | |
5518ac2a | 694 | int status; |
37b6f646 AV |
695 | |
696 | cmd = &desc.params.lldp_agent_ctrl; | |
697 | ||
698 | opcode = ice_aqc_opc_lldp_stop_start_specific_agent; | |
699 | ||
700 | ice_fill_dflt_direct_cmd_desc(&desc, opcode); | |
701 | ||
702 | if (start_dcbx_agent) | |
703 | cmd->command = ICE_AQC_START_STOP_AGENT_START_DCBX; | |
704 | ||
705 | status = ice_aq_send_cmd(hw, &desc, NULL, 0, cd); | |
706 | ||
707 | *dcbx_agent_status = false; | |
708 | ||
709 | if (!status && | |
710 | cmd->command == ICE_AQC_START_STOP_AGENT_START_DCBX) | |
711 | *dcbx_agent_status = true; | |
712 | ||
713 | return status; | |
714 | } | |
0ebd3ff1 AV |
715 | |
716 | /** | |
717 | * ice_aq_get_cee_dcb_cfg | |
718 | * @hw: pointer to the HW struct | |
719 | * @buff: response buffer that stores CEE operational configuration | |
720 | * @cd: pointer to command details structure or NULL | |
721 | * | |
722 | * Get CEE DCBX mode operational configuration from firmware (0x0A07) | |
723 | */ | |
5e24d598 | 724 | static int |
0ebd3ff1 AV |
725 | ice_aq_get_cee_dcb_cfg(struct ice_hw *hw, |
726 | struct ice_aqc_get_cee_dcb_cfg_resp *buff, | |
727 | struct ice_sq_cd *cd) | |
728 | { | |
729 | struct ice_aq_desc desc; | |
730 | ||
731 | ice_fill_dflt_direct_cmd_desc(&desc, ice_aqc_opc_get_cee_dcb_cfg); | |
732 | ||
733 | return ice_aq_send_cmd(hw, &desc, (void *)buff, sizeof(*buff), cd); | |
734 | } | |
735 | ||
2a87bd73 DE |
736 | /** |
737 | * ice_aq_set_pfc_mode - Set PFC mode | |
738 | * @hw: pointer to the HW struct | |
739 | * @pfc_mode: value of PFC mode to set | |
740 | * @cd: pointer to command details structure or NULL | |
741 | * | |
742 | * This AQ call configures the PFC mode to DSCP-based PFC mode or | |
743 | * VLAN-based PFC (0x0303) | |
744 | */ | |
745 | int ice_aq_set_pfc_mode(struct ice_hw *hw, u8 pfc_mode, struct ice_sq_cd *cd) | |
746 | { | |
747 | struct ice_aqc_set_query_pfc_mode *cmd; | |
748 | struct ice_aq_desc desc; | |
5e24d598 | 749 | int status; |
2a87bd73 DE |
750 | |
751 | if (pfc_mode > ICE_AQC_PFC_DSCP_BASED_PFC) | |
752 | return -EINVAL; | |
753 | ||
754 | cmd = &desc.params.set_query_pfc_mode; | |
755 | ||
756 | ice_fill_dflt_direct_cmd_desc(&desc, ice_aqc_opc_set_pfc_mode); | |
757 | ||
758 | cmd->pfc_mode = pfc_mode; | |
759 | ||
760 | status = ice_aq_send_cmd(hw, &desc, NULL, 0, cd); | |
761 | if (status) | |
d54699e2 | 762 | return status; |
2a87bd73 DE |
763 | |
764 | /* FW will write the PFC mode set back into cmd->pfc_mode, but if DCB is | |
765 | * disabled, FW will write back 0 to cmd->pfc_mode. After the AQ has | |
766 | * been executed, check if cmd->pfc_mode is what was requested. If not, | |
767 | * return an error. | |
768 | */ | |
769 | if (cmd->pfc_mode != pfc_mode) | |
770 | return -EOPNOTSUPP; | |
771 | ||
772 | return 0; | |
773 | } | |
774 | ||
0ebd3ff1 AV |
775 | /** |
776 | * ice_cee_to_dcb_cfg | |
777 | * @cee_cfg: pointer to CEE configuration struct | |
aeac8ce8 | 778 | * @pi: port information structure |
0ebd3ff1 AV |
779 | * |
780 | * Convert CEE configuration from firmware to DCB configuration | |
781 | */ | |
782 | static void | |
783 | ice_cee_to_dcb_cfg(struct ice_aqc_get_cee_dcb_cfg_resp *cee_cfg, | |
aeac8ce8 | 784 | struct ice_port_info *pi) |
0ebd3ff1 AV |
785 | { |
786 | u32 status, tlv_status = le32_to_cpu(cee_cfg->tlv_status); | |
ef963ae4 CIK |
787 | u32 ice_aqc_cee_status_mask, ice_aqc_cee_status_shift, j; |
788 | u8 i, err, sync, oper, app_index, ice_app_sel_type; | |
0ebd3ff1 | 789 | u16 app_prio = le16_to_cpu(cee_cfg->oper_app_prio); |
0ebd3ff1 | 790 | u16 ice_aqc_cee_app_mask, ice_aqc_cee_app_shift; |
aeac8ce8 | 791 | struct ice_dcbx_cfg *cmp_dcbcfg, *dcbcfg; |
0ebd3ff1 AV |
792 | u16 ice_app_prot_id_type; |
793 | ||
aeac8ce8 CC |
794 | dcbcfg = &pi->qos_cfg.local_dcbx_cfg; |
795 | dcbcfg->dcbx_mode = ICE_DCBX_MODE_CEE; | |
796 | dcbcfg->tlv_status = tlv_status; | |
797 | ||
798 | /* CEE PG data */ | |
0ebd3ff1 AV |
799 | dcbcfg->etscfg.maxtcs = cee_cfg->oper_num_tc; |
800 | ||
801 | /* Note that the FW creates the oper_prio_tc nibbles reversed | |
802 | * from those in the CEE Priority Group sub-TLV. | |
803 | */ | |
804 | for (i = 0; i < ICE_MAX_TRAFFIC_CLASS / 2; i++) { | |
805 | dcbcfg->etscfg.prio_table[i * 2] = | |
806 | ((cee_cfg->oper_prio_tc[i] & ICE_CEE_PGID_PRIO_0_M) >> | |
807 | ICE_CEE_PGID_PRIO_0_S); | |
808 | dcbcfg->etscfg.prio_table[i * 2 + 1] = | |
809 | ((cee_cfg->oper_prio_tc[i] & ICE_CEE_PGID_PRIO_1_M) >> | |
810 | ICE_CEE_PGID_PRIO_1_S); | |
811 | } | |
812 | ||
813 | ice_for_each_traffic_class(i) { | |
814 | dcbcfg->etscfg.tcbwtable[i] = cee_cfg->oper_tc_bw[i]; | |
815 | ||
816 | if (dcbcfg->etscfg.prio_table[i] == ICE_CEE_PGID_STRICT) { | |
817 | /* Map it to next empty TC */ | |
818 | dcbcfg->etscfg.prio_table[i] = cee_cfg->oper_num_tc - 1; | |
819 | dcbcfg->etscfg.tsatable[i] = ICE_IEEE_TSA_STRICT; | |
820 | } else { | |
821 | dcbcfg->etscfg.tsatable[i] = ICE_IEEE_TSA_ETS; | |
822 | } | |
823 | } | |
824 | ||
aeac8ce8 | 825 | /* CEE PFC data */ |
0ebd3ff1 AV |
826 | dcbcfg->pfc.pfcena = cee_cfg->oper_pfc_en; |
827 | dcbcfg->pfc.pfccap = ICE_MAX_TRAFFIC_CLASS; | |
828 | ||
aeac8ce8 CC |
829 | /* CEE APP TLV data */ |
830 | if (dcbcfg->app_mode == ICE_DCBX_APPS_NON_WILLING) | |
831 | cmp_dcbcfg = &pi->qos_cfg.desired_dcbx_cfg; | |
832 | else | |
833 | cmp_dcbcfg = &pi->qos_cfg.remote_dcbx_cfg; | |
834 | ||
0ebd3ff1 AV |
835 | app_index = 0; |
836 | for (i = 0; i < 3; i++) { | |
837 | if (i == 0) { | |
838 | /* FCoE APP */ | |
839 | ice_aqc_cee_status_mask = ICE_AQC_CEE_FCOE_STATUS_M; | |
840 | ice_aqc_cee_status_shift = ICE_AQC_CEE_FCOE_STATUS_S; | |
841 | ice_aqc_cee_app_mask = ICE_AQC_CEE_APP_FCOE_M; | |
842 | ice_aqc_cee_app_shift = ICE_AQC_CEE_APP_FCOE_S; | |
843 | ice_app_sel_type = ICE_APP_SEL_ETHTYPE; | |
d41f26b5 | 844 | ice_app_prot_id_type = ETH_P_FCOE; |
0ebd3ff1 AV |
845 | } else if (i == 1) { |
846 | /* iSCSI APP */ | |
847 | ice_aqc_cee_status_mask = ICE_AQC_CEE_ISCSI_STATUS_M; | |
848 | ice_aqc_cee_status_shift = ICE_AQC_CEE_ISCSI_STATUS_S; | |
849 | ice_aqc_cee_app_mask = ICE_AQC_CEE_APP_ISCSI_M; | |
850 | ice_aqc_cee_app_shift = ICE_AQC_CEE_APP_ISCSI_S; | |
851 | ice_app_sel_type = ICE_APP_SEL_TCPIP; | |
d41f26b5 | 852 | ice_app_prot_id_type = ISCSI_LISTEN_PORT; |
aeac8ce8 CC |
853 | |
854 | for (j = 0; j < cmp_dcbcfg->numapps; j++) { | |
855 | u16 prot_id = cmp_dcbcfg->app[j].prot_id; | |
856 | u8 sel = cmp_dcbcfg->app[j].selector; | |
857 | ||
858 | if (sel == ICE_APP_SEL_TCPIP && | |
d41f26b5 | 859 | (prot_id == ISCSI_LISTEN_PORT || |
aeac8ce8 CC |
860 | prot_id == ICE_APP_PROT_ID_ISCSI_860)) { |
861 | ice_app_prot_id_type = prot_id; | |
862 | break; | |
863 | } | |
864 | } | |
0ebd3ff1 AV |
865 | } else { |
866 | /* FIP APP */ | |
867 | ice_aqc_cee_status_mask = ICE_AQC_CEE_FIP_STATUS_M; | |
868 | ice_aqc_cee_status_shift = ICE_AQC_CEE_FIP_STATUS_S; | |
869 | ice_aqc_cee_app_mask = ICE_AQC_CEE_APP_FIP_M; | |
870 | ice_aqc_cee_app_shift = ICE_AQC_CEE_APP_FIP_S; | |
871 | ice_app_sel_type = ICE_APP_SEL_ETHTYPE; | |
d41f26b5 | 872 | ice_app_prot_id_type = ETH_P_FIP; |
0ebd3ff1 AV |
873 | } |
874 | ||
875 | status = (tlv_status & ice_aqc_cee_status_mask) >> | |
876 | ice_aqc_cee_status_shift; | |
877 | err = (status & ICE_TLV_STATUS_ERR) ? 1 : 0; | |
878 | sync = (status & ICE_TLV_STATUS_SYNC) ? 1 : 0; | |
879 | oper = (status & ICE_TLV_STATUS_OPER) ? 1 : 0; | |
880 | /* Add FCoE/iSCSI/FIP APP if Error is False and | |
881 | * Oper/Sync is True | |
882 | */ | |
883 | if (!err && sync && oper) { | |
884 | dcbcfg->app[app_index].priority = | |
885 | (app_prio & ice_aqc_cee_app_mask) >> | |
886 | ice_aqc_cee_app_shift; | |
887 | dcbcfg->app[app_index].selector = ice_app_sel_type; | |
888 | dcbcfg->app[app_index].prot_id = ice_app_prot_id_type; | |
889 | app_index++; | |
890 | } | |
891 | } | |
892 | ||
893 | dcbcfg->numapps = app_index; | |
894 | } | |
895 | ||
896 | /** | |
ef860480 | 897 | * ice_get_ieee_or_cee_dcb_cfg |
0ebd3ff1 AV |
898 | * @pi: port information structure |
899 | * @dcbx_mode: mode of DCBX (IEEE or CEE) | |
900 | * | |
901 | * Get IEEE or CEE mode DCB configuration from the Firmware | |
902 | */ | |
5518ac2a | 903 | static int ice_get_ieee_or_cee_dcb_cfg(struct ice_port_info *pi, u8 dcbx_mode) |
0ebd3ff1 AV |
904 | { |
905 | struct ice_dcbx_cfg *dcbx_cfg = NULL; | |
5e24d598 | 906 | int ret; |
0ebd3ff1 AV |
907 | |
908 | if (!pi) | |
d54699e2 | 909 | return -EINVAL; |
0ebd3ff1 AV |
910 | |
911 | if (dcbx_mode == ICE_DCBX_MODE_IEEE) | |
fc2d1165 | 912 | dcbx_cfg = &pi->qos_cfg.local_dcbx_cfg; |
0ebd3ff1 | 913 | else if (dcbx_mode == ICE_DCBX_MODE_CEE) |
fc2d1165 | 914 | dcbx_cfg = &pi->qos_cfg.desired_dcbx_cfg; |
0ebd3ff1 AV |
915 | |
916 | /* Get Local DCB Config in case of ICE_DCBX_MODE_IEEE | |
917 | * or get CEE DCB Desired Config in case of ICE_DCBX_MODE_CEE | |
918 | */ | |
919 | ret = ice_aq_get_dcb_cfg(pi->hw, ICE_AQ_LLDP_MIB_LOCAL, | |
920 | ICE_AQ_LLDP_BRID_TYPE_NEAREST_BRID, dcbx_cfg); | |
921 | if (ret) | |
922 | goto out; | |
923 | ||
924 | /* Get Remote DCB Config */ | |
fc2d1165 | 925 | dcbx_cfg = &pi->qos_cfg.remote_dcbx_cfg; |
0ebd3ff1 AV |
926 | ret = ice_aq_get_dcb_cfg(pi->hw, ICE_AQ_LLDP_MIB_REMOTE, |
927 | ICE_AQ_LLDP_BRID_TYPE_NEAREST_BRID, dcbx_cfg); | |
928 | /* Don't treat ENOENT as an error for Remote MIBs */ | |
929 | if (pi->hw->adminq.sq_last_status == ICE_AQ_RC_ENOENT) | |
930 | ret = 0; | |
931 | ||
932 | out: | |
933 | return ret; | |
934 | } | |
935 | ||
936 | /** | |
937 | * ice_get_dcb_cfg | |
938 | * @pi: port information structure | |
939 | * | |
940 | * Get DCB configuration from the Firmware | |
941 | */ | |
5e24d598 | 942 | int ice_get_dcb_cfg(struct ice_port_info *pi) |
0ebd3ff1 AV |
943 | { |
944 | struct ice_aqc_get_cee_dcb_cfg_resp cee_cfg; | |
945 | struct ice_dcbx_cfg *dcbx_cfg; | |
5e24d598 | 946 | int ret; |
0ebd3ff1 AV |
947 | |
948 | if (!pi) | |
d54699e2 | 949 | return -EINVAL; |
0ebd3ff1 AV |
950 | |
951 | ret = ice_aq_get_cee_dcb_cfg(pi->hw, &cee_cfg, NULL); | |
952 | if (!ret) { | |
953 | /* CEE mode */ | |
0ebd3ff1 | 954 | ret = ice_get_ieee_or_cee_dcb_cfg(pi, ICE_DCBX_MODE_CEE); |
aeac8ce8 | 955 | ice_cee_to_dcb_cfg(&cee_cfg, pi); |
0ebd3ff1 AV |
956 | } else if (pi->hw->adminq.sq_last_status == ICE_AQ_RC_ENOENT) { |
957 | /* CEE mode not enabled try querying IEEE data */ | |
fc2d1165 | 958 | dcbx_cfg = &pi->qos_cfg.local_dcbx_cfg; |
0ebd3ff1 AV |
959 | dcbx_cfg->dcbx_mode = ICE_DCBX_MODE_IEEE; |
960 | ret = ice_get_ieee_or_cee_dcb_cfg(pi, ICE_DCBX_MODE_IEEE); | |
961 | } | |
962 | ||
963 | return ret; | |
964 | } | |
965 | ||
966 | /** | |
967 | * ice_init_dcb | |
968 | * @hw: pointer to the HW struct | |
ea300f41 | 969 | * @enable_mib_change: enable MIB change event |
0ebd3ff1 AV |
970 | * |
971 | * Update DCB configuration from the Firmware | |
972 | */ | |
5e24d598 | 973 | int ice_init_dcb(struct ice_hw *hw, bool enable_mib_change) |
0ebd3ff1 | 974 | { |
fc2d1165 | 975 | struct ice_qos_cfg *qos_cfg = &hw->port_info->qos_cfg; |
5e24d598 | 976 | int ret = 0; |
0ebd3ff1 AV |
977 | |
978 | if (!hw->func_caps.common_cap.dcb) | |
d54699e2 | 979 | return -EOPNOTSUPP; |
0ebd3ff1 | 980 | |
fc2d1165 | 981 | qos_cfg->is_sw_lldp = true; |
0ebd3ff1 AV |
982 | |
983 | /* Get DCBX status */ | |
fc2d1165 | 984 | qos_cfg->dcbx_status = ice_get_dcbx_status(hw); |
0ebd3ff1 | 985 | |
fc2d1165 CC |
986 | if (qos_cfg->dcbx_status == ICE_DCBX_STATUS_DONE || |
987 | qos_cfg->dcbx_status == ICE_DCBX_STATUS_IN_PROGRESS || | |
988 | qos_cfg->dcbx_status == ICE_DCBX_STATUS_NOT_STARTED) { | |
0ebd3ff1 | 989 | /* Get current DCBX configuration */ |
fc2d1165 | 990 | ret = ice_get_dcb_cfg(hw->port_info); |
0ebd3ff1 AV |
991 | if (ret) |
992 | return ret; | |
fc2d1165 CC |
993 | qos_cfg->is_sw_lldp = false; |
994 | } else if (qos_cfg->dcbx_status == ICE_DCBX_STATUS_DIS) { | |
d54699e2 | 995 | return -EBUSY; |
0ebd3ff1 AV |
996 | } |
997 | ||
998 | /* Configure the LLDP MIB change event */ | |
ea300f41 DE |
999 | if (enable_mib_change) { |
1000 | ret = ice_aq_cfg_lldp_mib_change(hw, true, NULL); | |
b2883dfe | 1001 | if (ret) |
fc2d1165 | 1002 | qos_cfg->is_sw_lldp = true; |
ea300f41 DE |
1003 | } |
1004 | ||
1005 | return ret; | |
1006 | } | |
1007 | ||
1008 | /** | |
1009 | * ice_cfg_lldp_mib_change | |
1010 | * @hw: pointer to the HW struct | |
1011 | * @ena_mib: enable/disable MIB change event | |
1012 | * | |
1013 | * Configure (disable/enable) MIB | |
1014 | */ | |
5e24d598 | 1015 | int ice_cfg_lldp_mib_change(struct ice_hw *hw, bool ena_mib) |
ea300f41 | 1016 | { |
fc2d1165 | 1017 | struct ice_qos_cfg *qos_cfg = &hw->port_info->qos_cfg; |
5e24d598 | 1018 | int ret; |
ea300f41 DE |
1019 | |
1020 | if (!hw->func_caps.common_cap.dcb) | |
d54699e2 | 1021 | return -EOPNOTSUPP; |
ea300f41 DE |
1022 | |
1023 | /* Get DCBX status */ | |
fc2d1165 | 1024 | qos_cfg->dcbx_status = ice_get_dcbx_status(hw); |
ea300f41 | 1025 | |
fc2d1165 | 1026 | if (qos_cfg->dcbx_status == ICE_DCBX_STATUS_DIS) |
d54699e2 | 1027 | return -EBUSY; |
ea300f41 DE |
1028 | |
1029 | ret = ice_aq_cfg_lldp_mib_change(hw, ena_mib, NULL); | |
0ebd3ff1 | 1030 | if (!ret) |
fc2d1165 | 1031 | qos_cfg->is_sw_lldp = !ena_mib; |
0ebd3ff1 AV |
1032 | |
1033 | return ret; | |
1034 | } | |
7b9ffc76 AV |
1035 | |
1036 | /** | |
1037 | * ice_add_ieee_ets_common_tlv | |
1038 | * @buf: Data buffer to be populated with ice_dcb_ets_cfg data | |
1039 | * @ets_cfg: Container for ice_dcb_ets_cfg data | |
1040 | * | |
1041 | * Populate the TLV buffer with ice_dcb_ets_cfg data | |
1042 | */ | |
1043 | static void | |
1044 | ice_add_ieee_ets_common_tlv(u8 *buf, struct ice_dcb_ets_cfg *ets_cfg) | |
1045 | { | |
1046 | u8 priority0, priority1; | |
1047 | u8 offset = 0; | |
1048 | int i; | |
1049 | ||
1050 | /* Priority Assignment Table (4 octets) | |
1051 | * Octets:| 1 | 2 | 3 | 4 | | |
1052 | * ----------------------------------------- | |
1053 | * |pri0|pri1|pri2|pri3|pri4|pri5|pri6|pri7| | |
1054 | * ----------------------------------------- | |
1055 | * Bits:|7 4|3 0|7 4|3 0|7 4|3 0|7 4|3 0| | |
1056 | * ----------------------------------------- | |
1057 | */ | |
1058 | for (i = 0; i < ICE_MAX_TRAFFIC_CLASS / 2; i++) { | |
1059 | priority0 = ets_cfg->prio_table[i * 2] & 0xF; | |
1060 | priority1 = ets_cfg->prio_table[i * 2 + 1] & 0xF; | |
1061 | buf[offset] = (priority0 << ICE_IEEE_ETS_PRIO_1_S) | priority1; | |
1062 | offset++; | |
1063 | } | |
1064 | ||
1065 | /* TC Bandwidth Table (8 octets) | |
1066 | * Octets:| 1 | 2 | 3 | 4 | 5 | 6 | 7 | 8 | | |
1067 | * --------------------------------- | |
1068 | * |tc0|tc1|tc2|tc3|tc4|tc5|tc6|tc7| | |
1069 | * --------------------------------- | |
1070 | * | |
1071 | * TSA Assignment Table (8 octets) | |
1072 | * Octets:| 1 | 2 | 3 | 4 | 5 | 6 | 7 | 8 | | |
1073 | * --------------------------------- | |
1074 | * |tc0|tc1|tc2|tc3|tc4|tc5|tc6|tc7| | |
1075 | * --------------------------------- | |
1076 | */ | |
1077 | ice_for_each_traffic_class(i) { | |
1078 | buf[offset] = ets_cfg->tcbwtable[i]; | |
1079 | buf[ICE_MAX_TRAFFIC_CLASS + offset] = ets_cfg->tsatable[i]; | |
1080 | offset++; | |
1081 | } | |
1082 | } | |
1083 | ||
1084 | /** | |
1085 | * ice_add_ieee_ets_tlv - Prepare ETS TLV in IEEE format | |
1086 | * @tlv: Fill the ETS config data in IEEE format | |
1087 | * @dcbcfg: Local store which holds the DCB Config | |
1088 | * | |
1089 | * Prepare IEEE 802.1Qaz ETS CFG TLV | |
1090 | */ | |
1091 | static void | |
1092 | ice_add_ieee_ets_tlv(struct ice_lldp_org_tlv *tlv, struct ice_dcbx_cfg *dcbcfg) | |
1093 | { | |
1094 | struct ice_dcb_ets_cfg *etscfg; | |
1095 | u8 *buf = tlv->tlvinfo; | |
1096 | u8 maxtcwilling = 0; | |
1097 | u32 ouisubtype; | |
1098 | u16 typelen; | |
1099 | ||
1100 | typelen = ((ICE_TLV_TYPE_ORG << ICE_LLDP_TLV_TYPE_S) | | |
1101 | ICE_IEEE_ETS_TLV_LEN); | |
1102 | tlv->typelen = htons(typelen); | |
1103 | ||
1104 | ouisubtype = ((ICE_IEEE_8021QAZ_OUI << ICE_LLDP_TLV_OUI_S) | | |
1105 | ICE_IEEE_SUBTYPE_ETS_CFG); | |
1106 | tlv->ouisubtype = htonl(ouisubtype); | |
1107 | ||
1108 | /* First Octet post subtype | |
1109 | * -------------------------- | |
1110 | * |will-|CBS | Re- | Max | | |
1111 | * |ing | |served| TCs | | |
1112 | * -------------------------- | |
1113 | * |1bit | 1bit|3 bits|3bits| | |
1114 | */ | |
1115 | etscfg = &dcbcfg->etscfg; | |
1116 | if (etscfg->willing) | |
1117 | maxtcwilling = BIT(ICE_IEEE_ETS_WILLING_S); | |
1118 | maxtcwilling |= etscfg->maxtcs & ICE_IEEE_ETS_MAXTC_M; | |
1119 | buf[0] = maxtcwilling; | |
1120 | ||
1121 | /* Begin adding at Priority Assignment Table (offset 1 in buf) */ | |
1122 | ice_add_ieee_ets_common_tlv(&buf[1], etscfg); | |
1123 | } | |
1124 | ||
1125 | /** | |
1126 | * ice_add_ieee_etsrec_tlv - Prepare ETS Recommended TLV in IEEE format | |
1127 | * @tlv: Fill ETS Recommended TLV in IEEE format | |
1128 | * @dcbcfg: Local store which holds the DCB Config | |
1129 | * | |
1130 | * Prepare IEEE 802.1Qaz ETS REC TLV | |
1131 | */ | |
1132 | static void | |
1133 | ice_add_ieee_etsrec_tlv(struct ice_lldp_org_tlv *tlv, | |
1134 | struct ice_dcbx_cfg *dcbcfg) | |
1135 | { | |
1136 | struct ice_dcb_ets_cfg *etsrec; | |
1137 | u8 *buf = tlv->tlvinfo; | |
1138 | u32 ouisubtype; | |
1139 | u16 typelen; | |
1140 | ||
1141 | typelen = ((ICE_TLV_TYPE_ORG << ICE_LLDP_TLV_TYPE_S) | | |
1142 | ICE_IEEE_ETS_TLV_LEN); | |
1143 | tlv->typelen = htons(typelen); | |
1144 | ||
1145 | ouisubtype = ((ICE_IEEE_8021QAZ_OUI << ICE_LLDP_TLV_OUI_S) | | |
1146 | ICE_IEEE_SUBTYPE_ETS_REC); | |
1147 | tlv->ouisubtype = htonl(ouisubtype); | |
1148 | ||
1149 | etsrec = &dcbcfg->etsrec; | |
1150 | ||
1151 | /* First Octet is reserved */ | |
1152 | /* Begin adding at Priority Assignment Table (offset 1 in buf) */ | |
1153 | ice_add_ieee_ets_common_tlv(&buf[1], etsrec); | |
1154 | } | |
1155 | ||
1156 | /** | |
1157 | * ice_add_ieee_pfc_tlv - Prepare PFC TLV in IEEE format | |
1158 | * @tlv: Fill PFC TLV in IEEE format | |
1159 | * @dcbcfg: Local store which holds the PFC CFG data | |
1160 | * | |
1161 | * Prepare IEEE 802.1Qaz PFC CFG TLV | |
1162 | */ | |
1163 | static void | |
1164 | ice_add_ieee_pfc_tlv(struct ice_lldp_org_tlv *tlv, struct ice_dcbx_cfg *dcbcfg) | |
1165 | { | |
1166 | u8 *buf = tlv->tlvinfo; | |
1167 | u32 ouisubtype; | |
1168 | u16 typelen; | |
1169 | ||
1170 | typelen = ((ICE_TLV_TYPE_ORG << ICE_LLDP_TLV_TYPE_S) | | |
1171 | ICE_IEEE_PFC_TLV_LEN); | |
1172 | tlv->typelen = htons(typelen); | |
1173 | ||
1174 | ouisubtype = ((ICE_IEEE_8021QAZ_OUI << ICE_LLDP_TLV_OUI_S) | | |
1175 | ICE_IEEE_SUBTYPE_PFC_CFG); | |
1176 | tlv->ouisubtype = htonl(ouisubtype); | |
1177 | ||
1178 | /* ---------------------------------------- | |
1179 | * |will-|MBC | Re- | PFC | PFC Enable | | |
1180 | * |ing | |served| cap | | | |
1181 | * ----------------------------------------- | |
1182 | * |1bit | 1bit|2 bits|4bits| 1 octet | | |
1183 | */ | |
1184 | if (dcbcfg->pfc.willing) | |
1185 | buf[0] = BIT(ICE_IEEE_PFC_WILLING_S); | |
1186 | ||
1187 | if (dcbcfg->pfc.mbc) | |
1188 | buf[0] |= BIT(ICE_IEEE_PFC_MBC_S); | |
1189 | ||
1190 | buf[0] |= dcbcfg->pfc.pfccap & 0xF; | |
1191 | buf[1] = dcbcfg->pfc.pfcena; | |
1192 | } | |
1193 | ||
1194 | /** | |
1195 | * ice_add_ieee_app_pri_tlv - Prepare APP TLV in IEEE format | |
1196 | * @tlv: Fill APP TLV in IEEE format | |
1197 | * @dcbcfg: Local store which holds the APP CFG data | |
1198 | * | |
1199 | * Prepare IEEE 802.1Qaz APP CFG TLV | |
1200 | */ | |
1201 | static void | |
1202 | ice_add_ieee_app_pri_tlv(struct ice_lldp_org_tlv *tlv, | |
1203 | struct ice_dcbx_cfg *dcbcfg) | |
1204 | { | |
1205 | u16 typelen, len, offset = 0; | |
1206 | u8 priority, selector, i = 0; | |
1207 | u8 *buf = tlv->tlvinfo; | |
1208 | u32 ouisubtype; | |
1209 | ||
1210 | /* No APP TLVs then just return */ | |
1211 | if (dcbcfg->numapps == 0) | |
1212 | return; | |
1213 | ouisubtype = ((ICE_IEEE_8021QAZ_OUI << ICE_LLDP_TLV_OUI_S) | | |
1214 | ICE_IEEE_SUBTYPE_APP_PRI); | |
1215 | tlv->ouisubtype = htonl(ouisubtype); | |
1216 | ||
1217 | /* Move offset to App Priority Table */ | |
1218 | offset++; | |
1219 | /* Application Priority Table (3 octets) | |
1220 | * Octets:| 1 | 2 | 3 | | |
1221 | * ----------------------------------------- | |
1222 | * |Priority|Rsrvd| Sel | Protocol ID | | |
1223 | * ----------------------------------------- | |
1224 | * Bits:|23 21|20 19|18 16|15 0| | |
1225 | * ----------------------------------------- | |
1226 | */ | |
1227 | while (i < dcbcfg->numapps) { | |
1228 | priority = dcbcfg->app[i].priority & 0x7; | |
1229 | selector = dcbcfg->app[i].selector & 0x7; | |
1230 | buf[offset] = (priority << ICE_IEEE_APP_PRIO_S) | selector; | |
1231 | buf[offset + 1] = (dcbcfg->app[i].prot_id >> 0x8) & 0xFF; | |
1232 | buf[offset + 2] = dcbcfg->app[i].prot_id & 0xFF; | |
1233 | /* Move to next app */ | |
1234 | offset += 3; | |
1235 | i++; | |
1236 | if (i >= ICE_DCBX_MAX_APPS) | |
1237 | break; | |
1238 | } | |
1239 | /* len includes size of ouisubtype + 1 reserved + 3*numapps */ | |
1240 | len = sizeof(tlv->ouisubtype) + 1 + (i * 3); | |
1241 | typelen = ((ICE_TLV_TYPE_ORG << ICE_LLDP_TLV_TYPE_S) | (len & 0x1FF)); | |
1242 | tlv->typelen = htons(typelen); | |
1243 | } | |
1244 | ||
1245 | /** | |
2a87bd73 DE |
1246 | * ice_add_dscp_up_tlv - Prepare DSCP to UP TLV |
1247 | * @tlv: location to build the TLV data | |
1248 | * @dcbcfg: location of data to convert to TLV | |
1249 | */ | |
1250 | static void | |
1251 | ice_add_dscp_up_tlv(struct ice_lldp_org_tlv *tlv, struct ice_dcbx_cfg *dcbcfg) | |
1252 | { | |
1253 | u8 *buf = tlv->tlvinfo; | |
1254 | u32 ouisubtype; | |
1255 | u16 typelen; | |
1256 | int i; | |
1257 | ||
1258 | typelen = ((ICE_TLV_TYPE_ORG << ICE_LLDP_TLV_TYPE_S) | | |
1259 | ICE_DSCP_UP_TLV_LEN); | |
1260 | tlv->typelen = htons(typelen); | |
1261 | ||
1262 | ouisubtype = (u32)((ICE_DSCP_OUI << ICE_LLDP_TLV_OUI_S) | | |
1263 | ICE_DSCP_SUBTYPE_DSCP2UP); | |
1264 | tlv->ouisubtype = htonl(ouisubtype); | |
1265 | ||
1266 | /* bytes 0 - 63 - IPv4 DSCP2UP LUT */ | |
1267 | for (i = 0; i < ICE_DSCP_NUM_VAL; i++) { | |
1268 | /* IPv4 mapping */ | |
1269 | buf[i] = dcbcfg->dscp_map[i]; | |
1270 | /* IPv6 mapping */ | |
1271 | buf[i + ICE_DSCP_IPV6_OFFSET] = dcbcfg->dscp_map[i]; | |
1272 | } | |
1273 | ||
1274 | /* byte 64 - IPv4 untagged traffic */ | |
1275 | buf[i] = 0; | |
1276 | ||
1277 | /* byte 144 - IPv6 untagged traffic */ | |
1278 | buf[i + ICE_DSCP_IPV6_OFFSET] = 0; | |
1279 | } | |
1280 | ||
1281 | #define ICE_BYTES_PER_TC 8 | |
1282 | /** | |
1283 | * ice_add_dscp_enf_tlv - Prepare DSCP Enforcement TLV | |
1284 | * @tlv: location to build the TLV data | |
1285 | */ | |
1286 | static void | |
1287 | ice_add_dscp_enf_tlv(struct ice_lldp_org_tlv *tlv) | |
1288 | { | |
1289 | u8 *buf = tlv->tlvinfo; | |
1290 | u32 ouisubtype; | |
1291 | u16 typelen; | |
1292 | ||
1293 | typelen = ((ICE_TLV_TYPE_ORG << ICE_LLDP_TLV_TYPE_S) | | |
1294 | ICE_DSCP_ENF_TLV_LEN); | |
1295 | tlv->typelen = htons(typelen); | |
1296 | ||
1297 | ouisubtype = (u32)((ICE_DSCP_OUI << ICE_LLDP_TLV_OUI_S) | | |
1298 | ICE_DSCP_SUBTYPE_ENFORCE); | |
1299 | tlv->ouisubtype = htonl(ouisubtype); | |
1300 | ||
1301 | /* Allow all DSCP values to be valid for all TC's (IPv4 and IPv6) */ | |
1302 | memset(buf, 0, 2 * (ICE_MAX_TRAFFIC_CLASS * ICE_BYTES_PER_TC)); | |
1303 | } | |
1304 | ||
1305 | /** | |
1306 | * ice_add_dscp_tc_bw_tlv - Prepare DSCP BW for TC TLV | |
1307 | * @tlv: location to build the TLV data | |
1308 | * @dcbcfg: location of the data to convert to TLV | |
1309 | */ | |
1310 | static void | |
1311 | ice_add_dscp_tc_bw_tlv(struct ice_lldp_org_tlv *tlv, | |
1312 | struct ice_dcbx_cfg *dcbcfg) | |
1313 | { | |
1314 | struct ice_dcb_ets_cfg *etscfg; | |
1315 | u8 *buf = tlv->tlvinfo; | |
1316 | u32 ouisubtype; | |
1317 | u8 offset = 0; | |
1318 | u16 typelen; | |
1319 | int i; | |
1320 | ||
1321 | typelen = ((ICE_TLV_TYPE_ORG << ICE_LLDP_TLV_TYPE_S) | | |
1322 | ICE_DSCP_TC_BW_TLV_LEN); | |
1323 | tlv->typelen = htons(typelen); | |
1324 | ||
1325 | ouisubtype = (u32)((ICE_DSCP_OUI << ICE_LLDP_TLV_OUI_S) | | |
1326 | ICE_DSCP_SUBTYPE_TCBW); | |
1327 | tlv->ouisubtype = htonl(ouisubtype); | |
1328 | ||
1329 | /* First Octect after subtype | |
1330 | * ---------------------------- | |
1331 | * | RSV | CBS | RSV | Max TCs | | |
1332 | * | 1b | 1b | 3b | 3b | | |
1333 | * ---------------------------- | |
1334 | */ | |
1335 | etscfg = &dcbcfg->etscfg; | |
1336 | buf[0] = etscfg->maxtcs & ICE_IEEE_ETS_MAXTC_M; | |
1337 | ||
1338 | /* bytes 1 - 4 reserved */ | |
1339 | offset = 5; | |
1340 | ||
1341 | /* TC BW table | |
1342 | * bytes 0 - 7 for TC 0 - 7 | |
1343 | * | |
1344 | * TSA Assignment table | |
1345 | * bytes 8 - 15 for TC 0 - 7 | |
1346 | */ | |
1347 | for (i = 0; i < ICE_MAX_TRAFFIC_CLASS; i++) { | |
1348 | buf[offset] = etscfg->tcbwtable[i]; | |
1349 | buf[offset + ICE_MAX_TRAFFIC_CLASS] = etscfg->tsatable[i]; | |
1350 | offset++; | |
1351 | } | |
1352 | } | |
1353 | ||
1354 | /** | |
1355 | * ice_add_dscp_pfc_tlv - Prepare DSCP PFC TLV | |
1356 | * @tlv: Fill PFC TLV in IEEE format | |
1357 | * @dcbcfg: Local store which holds the PFC CFG data | |
1358 | */ | |
1359 | static void | |
1360 | ice_add_dscp_pfc_tlv(struct ice_lldp_org_tlv *tlv, struct ice_dcbx_cfg *dcbcfg) | |
1361 | { | |
1362 | u8 *buf = tlv->tlvinfo; | |
1363 | u32 ouisubtype; | |
1364 | u16 typelen; | |
1365 | ||
1366 | typelen = ((ICE_TLV_TYPE_ORG << ICE_LLDP_TLV_TYPE_S) | | |
1367 | ICE_DSCP_PFC_TLV_LEN); | |
1368 | tlv->typelen = htons(typelen); | |
1369 | ||
1370 | ouisubtype = (u32)((ICE_DSCP_OUI << ICE_LLDP_TLV_OUI_S) | | |
1371 | ICE_DSCP_SUBTYPE_PFC); | |
1372 | tlv->ouisubtype = htonl(ouisubtype); | |
1373 | ||
1374 | buf[0] = dcbcfg->pfc.pfccap & 0xF; | |
1375 | buf[1] = dcbcfg->pfc.pfcena & 0xF; | |
1376 | } | |
1377 | ||
1378 | /** | |
1379 | * ice_add_dcb_tlv - Add all IEEE or DSCP TLVs | |
7b9ffc76 AV |
1380 | * @tlv: Fill TLV data in IEEE format |
1381 | * @dcbcfg: Local store which holds the DCB Config | |
1382 | * @tlvid: Type of IEEE TLV | |
1383 | * | |
1384 | * Add tlv information | |
1385 | */ | |
1386 | static void | |
1387 | ice_add_dcb_tlv(struct ice_lldp_org_tlv *tlv, struct ice_dcbx_cfg *dcbcfg, | |
1388 | u16 tlvid) | |
1389 | { | |
2a87bd73 DE |
1390 | if (dcbcfg->pfc_mode == ICE_QOS_MODE_VLAN) { |
1391 | switch (tlvid) { | |
1392 | case ICE_IEEE_TLV_ID_ETS_CFG: | |
1393 | ice_add_ieee_ets_tlv(tlv, dcbcfg); | |
1394 | break; | |
1395 | case ICE_IEEE_TLV_ID_ETS_REC: | |
1396 | ice_add_ieee_etsrec_tlv(tlv, dcbcfg); | |
1397 | break; | |
1398 | case ICE_IEEE_TLV_ID_PFC_CFG: | |
1399 | ice_add_ieee_pfc_tlv(tlv, dcbcfg); | |
1400 | break; | |
1401 | case ICE_IEEE_TLV_ID_APP_PRI: | |
1402 | ice_add_ieee_app_pri_tlv(tlv, dcbcfg); | |
1403 | break; | |
1404 | default: | |
1405 | break; | |
1406 | } | |
1407 | } else { | |
1408 | /* pfc_mode == ICE_QOS_MODE_DSCP */ | |
1409 | switch (tlvid) { | |
1410 | case ICE_TLV_ID_DSCP_UP: | |
1411 | ice_add_dscp_up_tlv(tlv, dcbcfg); | |
1412 | break; | |
1413 | case ICE_TLV_ID_DSCP_ENF: | |
1414 | ice_add_dscp_enf_tlv(tlv); | |
1415 | break; | |
1416 | case ICE_TLV_ID_DSCP_TC_BW: | |
1417 | ice_add_dscp_tc_bw_tlv(tlv, dcbcfg); | |
1418 | break; | |
1419 | case ICE_TLV_ID_DSCP_TO_PFC: | |
1420 | ice_add_dscp_pfc_tlv(tlv, dcbcfg); | |
1421 | break; | |
1422 | default: | |
1423 | break; | |
1424 | } | |
7b9ffc76 AV |
1425 | } |
1426 | } | |
1427 | ||
1428 | /** | |
1429 | * ice_dcb_cfg_to_lldp - Convert DCB configuration to MIB format | |
1430 | * @lldpmib: pointer to the HW struct | |
1431 | * @miblen: length of LLDP MIB | |
1432 | * @dcbcfg: Local store which holds the DCB Config | |
1433 | * | |
1434 | * Convert the DCB configuration to MIB format | |
1435 | */ | |
1436 | static void | |
1437 | ice_dcb_cfg_to_lldp(u8 *lldpmib, u16 *miblen, struct ice_dcbx_cfg *dcbcfg) | |
1438 | { | |
1439 | u16 len, offset = 0, tlvid = ICE_TLV_ID_START; | |
1440 | struct ice_lldp_org_tlv *tlv; | |
1441 | u16 typelen; | |
1442 | ||
1443 | tlv = (struct ice_lldp_org_tlv *)lldpmib; | |
1444 | while (1) { | |
1445 | ice_add_dcb_tlv(tlv, dcbcfg, tlvid++); | |
1446 | typelen = ntohs(tlv->typelen); | |
1447 | len = (typelen & ICE_LLDP_TLV_LEN_M) >> ICE_LLDP_TLV_LEN_S; | |
1448 | if (len) | |
1449 | offset += len + 2; | |
1450 | /* END TLV or beyond LLDPDU size */ | |
1451 | if (tlvid >= ICE_TLV_ID_END_OF_LLDPPDU || | |
1452 | offset > ICE_LLDPDU_SIZE) | |
1453 | break; | |
1454 | /* Move to next TLV */ | |
1455 | if (len) | |
1456 | tlv = (struct ice_lldp_org_tlv *) | |
1457 | ((char *)tlv + sizeof(tlv->typelen) + len); | |
1458 | } | |
1459 | *miblen = offset; | |
1460 | } | |
1461 | ||
1462 | /** | |
1463 | * ice_set_dcb_cfg - Set the local LLDP MIB to FW | |
1464 | * @pi: port information structure | |
1465 | * | |
1466 | * Set DCB configuration to the Firmware | |
1467 | */ | |
5e24d598 | 1468 | int ice_set_dcb_cfg(struct ice_port_info *pi) |
7b9ffc76 AV |
1469 | { |
1470 | u8 mib_type, *lldpmib = NULL; | |
1471 | struct ice_dcbx_cfg *dcbcfg; | |
7b9ffc76 AV |
1472 | struct ice_hw *hw; |
1473 | u16 miblen; | |
5518ac2a | 1474 | int ret; |
7b9ffc76 AV |
1475 | |
1476 | if (!pi) | |
d54699e2 | 1477 | return -EINVAL; |
7b9ffc76 AV |
1478 | |
1479 | hw = pi->hw; | |
1480 | ||
1481 | /* update the HW local config */ | |
fc2d1165 | 1482 | dcbcfg = &pi->qos_cfg.local_dcbx_cfg; |
7b9ffc76 AV |
1483 | /* Allocate the LLDPDU */ |
1484 | lldpmib = devm_kzalloc(ice_hw_to_dev(hw), ICE_LLDPDU_SIZE, GFP_KERNEL); | |
1485 | if (!lldpmib) | |
d54699e2 | 1486 | return -ENOMEM; |
7b9ffc76 AV |
1487 | |
1488 | mib_type = SET_LOCAL_MIB_TYPE_LOCAL_MIB; | |
1489 | if (dcbcfg->app_mode == ICE_DCBX_APPS_NON_WILLING) | |
1490 | mib_type |= SET_LOCAL_MIB_TYPE_CEE_NON_WILLING; | |
1491 | ||
1492 | ice_dcb_cfg_to_lldp(lldpmib, &miblen, dcbcfg); | |
1493 | ret = ice_aq_set_lldp_mib(hw, mib_type, (void *)lldpmib, miblen, | |
1494 | NULL); | |
1495 | ||
1496 | devm_kfree(ice_hw_to_dev(hw), lldpmib); | |
1497 | ||
1498 | return ret; | |
1499 | } | |
1500 | ||
1501 | /** | |
4ee656bb | 1502 | * ice_aq_query_port_ets - query port ETS configuration |
7b9ffc76 AV |
1503 | * @pi: port information structure |
1504 | * @buf: pointer to buffer | |
1505 | * @buf_size: buffer size in bytes | |
1506 | * @cd: pointer to command details structure or NULL | |
1507 | * | |
4ee656bb | 1508 | * query current port ETS configuration |
7b9ffc76 | 1509 | */ |
5e24d598 | 1510 | static int |
7b9ffc76 AV |
1511 | ice_aq_query_port_ets(struct ice_port_info *pi, |
1512 | struct ice_aqc_port_ets_elem *buf, u16 buf_size, | |
1513 | struct ice_sq_cd *cd) | |
1514 | { | |
1515 | struct ice_aqc_query_port_ets *cmd; | |
1516 | struct ice_aq_desc desc; | |
5e24d598 | 1517 | int status; |
7b9ffc76 AV |
1518 | |
1519 | if (!pi) | |
d54699e2 | 1520 | return -EINVAL; |
7b9ffc76 AV |
1521 | cmd = &desc.params.port_ets; |
1522 | ice_fill_dflt_direct_cmd_desc(&desc, ice_aqc_opc_query_port_ets); | |
1523 | cmd->port_teid = pi->root->info.node_teid; | |
1524 | ||
1525 | status = ice_aq_send_cmd(pi->hw, &desc, buf, buf_size, cd); | |
1526 | return status; | |
1527 | } | |
1528 | ||
1529 | /** | |
1530 | * ice_update_port_tc_tree_cfg - update TC tree configuration | |
1531 | * @pi: port information structure | |
1532 | * @buf: pointer to buffer | |
1533 | * | |
1534 | * update the SW DB with the new TC changes | |
1535 | */ | |
5e24d598 | 1536 | static int |
7b9ffc76 AV |
1537 | ice_update_port_tc_tree_cfg(struct ice_port_info *pi, |
1538 | struct ice_aqc_port_ets_elem *buf) | |
1539 | { | |
1540 | struct ice_sched_node *node, *tc_node; | |
b3c38904 | 1541 | struct ice_aqc_txsched_elem_data elem; |
7b9ffc76 | 1542 | u32 teid1, teid2; |
5518ac2a | 1543 | int status = 0; |
7b9ffc76 AV |
1544 | u8 i, j; |
1545 | ||
1546 | if (!pi) | |
d54699e2 | 1547 | return -EINVAL; |
7b9ffc76 AV |
1548 | /* suspend the missing TC nodes */ |
1549 | for (i = 0; i < pi->root->num_children; i++) { | |
1550 | teid1 = le32_to_cpu(pi->root->children[i]->info.node_teid); | |
1551 | ice_for_each_traffic_class(j) { | |
1552 | teid2 = le32_to_cpu(buf->tc_node_teid[j]); | |
1553 | if (teid1 == teid2) | |
1554 | break; | |
1555 | } | |
1556 | if (j < ICE_MAX_TRAFFIC_CLASS) | |
1557 | continue; | |
1558 | /* TC is missing */ | |
1559 | pi->root->children[i]->in_use = false; | |
1560 | } | |
1561 | /* add the new TC nodes */ | |
1562 | ice_for_each_traffic_class(j) { | |
1563 | teid2 = le32_to_cpu(buf->tc_node_teid[j]); | |
1564 | if (teid2 == ICE_INVAL_TEID) | |
1565 | continue; | |
1566 | /* Is it already present in the tree ? */ | |
1567 | for (i = 0; i < pi->root->num_children; i++) { | |
1568 | tc_node = pi->root->children[i]; | |
1569 | if (!tc_node) | |
1570 | continue; | |
1571 | teid1 = le32_to_cpu(tc_node->info.node_teid); | |
1572 | if (teid1 == teid2) { | |
1573 | tc_node->tc_num = j; | |
1574 | tc_node->in_use = true; | |
1575 | break; | |
1576 | } | |
1577 | } | |
1578 | if (i < pi->root->num_children) | |
1579 | continue; | |
1580 | /* new TC */ | |
1581 | status = ice_sched_query_elem(pi->hw, teid2, &elem); | |
1582 | if (!status) | |
b3c38904 | 1583 | status = ice_sched_add_node(pi, 1, &elem); |
7b9ffc76 AV |
1584 | if (status) |
1585 | break; | |
1586 | /* update the TC number */ | |
1587 | node = ice_sched_find_node_by_teid(pi->root, teid2); | |
1588 | if (node) | |
1589 | node->tc_num = j; | |
1590 | } | |
1591 | return status; | |
1592 | } | |
1593 | ||
1594 | /** | |
4ee656bb | 1595 | * ice_query_port_ets - query port ETS configuration |
7b9ffc76 AV |
1596 | * @pi: port information structure |
1597 | * @buf: pointer to buffer | |
1598 | * @buf_size: buffer size in bytes | |
1599 | * @cd: pointer to command details structure or NULL | |
1600 | * | |
4ee656bb | 1601 | * query current port ETS configuration and update the |
7b9ffc76 AV |
1602 | * SW DB with the TC changes |
1603 | */ | |
5e24d598 | 1604 | int |
7b9ffc76 AV |
1605 | ice_query_port_ets(struct ice_port_info *pi, |
1606 | struct ice_aqc_port_ets_elem *buf, u16 buf_size, | |
1607 | struct ice_sq_cd *cd) | |
1608 | { | |
5e24d598 | 1609 | int status; |
7b9ffc76 AV |
1610 | |
1611 | mutex_lock(&pi->sched_lock); | |
1612 | status = ice_aq_query_port_ets(pi, buf, buf_size, cd); | |
1613 | if (!status) | |
1614 | status = ice_update_port_tc_tree_cfg(pi, buf); | |
1615 | mutex_unlock(&pi->sched_lock); | |
1616 | return status; | |
1617 | } |