1 /* QLogic qed NIC Driver
2 * Copyright (c) 2015-2017 QLogic Corporation
4 * This software is available to you under a choice of one of two
5 * licenses. You may choose to be licensed under the terms of the GNU
6 * General Public License (GPL) Version 2, available from the file
7 * COPYING in the main directory of this source tree, or the
8 * OpenIB.org BSD license below:
10 * Redistribution and use in source and binary forms, with or
11 * without modification, are permitted provided that the following
14 * - Redistributions of source code must retain the above
15 * copyright notice, this list of conditions and the following
18 * - Redistributions in binary form must reproduce the above
19 * copyright notice, this list of conditions and the following
20 * disclaimer in the documentation and /or other materials
21 * provided with the distribution.
23 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
24 * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
25 * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
26 * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
27 * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
28 * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
29 * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
33 #include <linux/types.h>
34 #include <asm/byteorder.h>
35 #include <linux/bitops.h>
36 #include <linux/dcbnl.h>
37 #include <linux/errno.h>
38 #include <linux/kernel.h>
39 #include <linux/slab.h>
40 #include <linux/string.h>
46 #include "qed_sriov.h"
48 #include <linux/qed/qed_eth_if.h>
51 #define QED_DCBX_MAX_MIB_READ_TRY (100)
52 #define QED_ETH_TYPE_DEFAULT (0)
53 #define QED_ETH_TYPE_ROCE (0x8915)
54 #define QED_UDP_PORT_TYPE_ROCE_V2 (0x12B7)
55 #define QED_ETH_TYPE_FCOE (0x8906)
56 #define QED_TCP_PORT_ISCSI (0xCBC)
58 #define QED_DCBX_INVALID_PRIORITY 0xFF
60 /* Get Traffic Class from priority traffic class table, 4 bits represent
61 * the traffic class corresponding to the priority.
63 #define QED_DCBX_PRIO2TC(prio_tc_tbl, prio) \
64 ((u32)(prio_tc_tbl >> ((7 - prio) * 4)) & 0x7)
66 static const struct qed_dcbx_app_metadata qed_dcbx_app_update
[] = {
67 {DCBX_PROTOCOL_ISCSI
, "ISCSI", QED_PCI_DEFAULT
},
68 {DCBX_PROTOCOL_FCOE
, "FCOE", QED_PCI_DEFAULT
},
69 {DCBX_PROTOCOL_ROCE
, "ROCE", QED_PCI_DEFAULT
},
70 {DCBX_PROTOCOL_ROCE_V2
, "ROCE_V2", QED_PCI_DEFAULT
},
71 {DCBX_PROTOCOL_ETH
, "ETH", QED_PCI_ETH
}
74 static bool qed_dcbx_app_ethtype(u32 app_info_bitmap
)
76 return !!(QED_MFW_GET_FIELD(app_info_bitmap
, DCBX_APP_SF
) ==
80 static bool qed_dcbx_ieee_app_ethtype(u32 app_info_bitmap
)
82 u8 mfw_val
= QED_MFW_GET_FIELD(app_info_bitmap
, DCBX_APP_SF_IEEE
);
85 if (mfw_val
== DCBX_APP_SF_IEEE_RESERVED
)
86 return qed_dcbx_app_ethtype(app_info_bitmap
);
88 return !!(mfw_val
== DCBX_APP_SF_IEEE_ETHTYPE
);
91 static bool qed_dcbx_app_port(u32 app_info_bitmap
)
93 return !!(QED_MFW_GET_FIELD(app_info_bitmap
, DCBX_APP_SF
) ==
97 static bool qed_dcbx_ieee_app_port(u32 app_info_bitmap
, u8 type
)
99 u8 mfw_val
= QED_MFW_GET_FIELD(app_info_bitmap
, DCBX_APP_SF_IEEE
);
102 if (mfw_val
== DCBX_APP_SF_IEEE_RESERVED
)
103 return qed_dcbx_app_port(app_info_bitmap
);
105 return !!(mfw_val
== type
|| mfw_val
== DCBX_APP_SF_IEEE_TCP_UDP_PORT
);
108 static bool qed_dcbx_default_tlv(u32 app_info_bitmap
, u16 proto_id
, bool ieee
)
113 ethtype
= qed_dcbx_ieee_app_ethtype(app_info_bitmap
);
115 ethtype
= qed_dcbx_app_ethtype(app_info_bitmap
);
117 return !!(ethtype
&& (proto_id
== QED_ETH_TYPE_DEFAULT
));
120 static bool qed_dcbx_iscsi_tlv(u32 app_info_bitmap
, u16 proto_id
, bool ieee
)
125 port
= qed_dcbx_ieee_app_port(app_info_bitmap
,
126 DCBX_APP_SF_IEEE_TCP_PORT
);
128 port
= qed_dcbx_app_port(app_info_bitmap
);
130 return !!(port
&& (proto_id
== QED_TCP_PORT_ISCSI
));
133 static bool qed_dcbx_fcoe_tlv(u32 app_info_bitmap
, u16 proto_id
, bool ieee
)
138 ethtype
= qed_dcbx_ieee_app_ethtype(app_info_bitmap
);
140 ethtype
= qed_dcbx_app_ethtype(app_info_bitmap
);
142 return !!(ethtype
&& (proto_id
== QED_ETH_TYPE_FCOE
));
145 static bool qed_dcbx_roce_tlv(u32 app_info_bitmap
, u16 proto_id
, bool ieee
)
150 ethtype
= qed_dcbx_ieee_app_ethtype(app_info_bitmap
);
152 ethtype
= qed_dcbx_app_ethtype(app_info_bitmap
);
154 return !!(ethtype
&& (proto_id
== QED_ETH_TYPE_ROCE
));
157 static bool qed_dcbx_roce_v2_tlv(u32 app_info_bitmap
, u16 proto_id
, bool ieee
)
162 port
= qed_dcbx_ieee_app_port(app_info_bitmap
,
163 DCBX_APP_SF_IEEE_UDP_PORT
);
165 port
= qed_dcbx_app_port(app_info_bitmap
);
167 return !!(port
&& (proto_id
== QED_UDP_PORT_TYPE_ROCE_V2
));
171 qed_dcbx_dp_protocol(struct qed_hwfn
*p_hwfn
, struct qed_dcbx_results
*p_data
)
173 enum dcbx_protocol_type id
;
176 DP_VERBOSE(p_hwfn
, QED_MSG_DCB
, "DCBX negotiated: %d\n",
177 p_data
->dcbx_enabled
);
179 for (i
= 0; i
< ARRAY_SIZE(qed_dcbx_app_update
); i
++) {
180 id
= qed_dcbx_app_update
[i
].id
;
182 DP_VERBOSE(p_hwfn
, QED_MSG_DCB
,
183 "%s info: update %d, enable %d, prio %d, tc %d, num_tc %d\n",
184 qed_dcbx_app_update
[i
].name
, p_data
->arr
[id
].update
,
185 p_data
->arr
[id
].enable
, p_data
->arr
[id
].priority
,
186 p_data
->arr
[id
].tc
, p_hwfn
->hw_info
.num_active_tc
);
191 qed_dcbx_set_params(struct qed_dcbx_results
*p_data
,
192 struct qed_hw_info
*p_info
,
197 enum dcbx_protocol_type type
,
198 enum qed_pci_personality personality
)
200 /* PF update ramrod data */
201 p_data
->arr
[type
].update
= update
;
202 p_data
->arr
[type
].enable
= enable
;
203 p_data
->arr
[type
].priority
= prio
;
204 p_data
->arr
[type
].tc
= tc
;
207 if (p_info
->personality
== personality
)
208 p_info
->offload_tc
= tc
;
211 /* Update app protocol data and hw_info fields with the TLV info */
213 qed_dcbx_update_app_info(struct qed_dcbx_results
*p_data
,
214 struct qed_hwfn
*p_hwfn
,
217 u8 prio
, u8 tc
, enum dcbx_protocol_type type
)
219 struct qed_hw_info
*p_info
= &p_hwfn
->hw_info
;
220 enum qed_pci_personality personality
;
221 enum dcbx_protocol_type id
;
225 for (i
= 0; i
< ARRAY_SIZE(qed_dcbx_app_update
); i
++) {
226 id
= qed_dcbx_app_update
[i
].id
;
231 personality
= qed_dcbx_app_update
[i
].personality
;
232 name
= qed_dcbx_app_update
[i
].name
;
234 qed_dcbx_set_params(p_data
, p_info
, enable
, update
,
235 prio
, tc
, type
, personality
);
240 qed_dcbx_get_app_protocol_type(struct qed_hwfn
*p_hwfn
,
242 u16 id
, enum dcbx_protocol_type
*type
, bool ieee
)
244 if (qed_dcbx_fcoe_tlv(app_prio_bitmap
, id
, ieee
)) {
245 *type
= DCBX_PROTOCOL_FCOE
;
246 } else if (qed_dcbx_roce_tlv(app_prio_bitmap
, id
, ieee
)) {
247 *type
= DCBX_PROTOCOL_ROCE
;
248 } else if (qed_dcbx_iscsi_tlv(app_prio_bitmap
, id
, ieee
)) {
249 *type
= DCBX_PROTOCOL_ISCSI
;
250 } else if (qed_dcbx_default_tlv(app_prio_bitmap
, id
, ieee
)) {
251 *type
= DCBX_PROTOCOL_ETH
;
252 } else if (qed_dcbx_roce_v2_tlv(app_prio_bitmap
, id
, ieee
)) {
253 *type
= DCBX_PROTOCOL_ROCE_V2
;
255 *type
= DCBX_MAX_PROTOCOL_TYPE
;
257 "No action required, App TLV id = 0x%x app_prio_bitmap = 0x%x\n",
258 id
, app_prio_bitmap
);
265 /* Parse app TLV's to update TC information in hw_info structure for
266 * reconfiguring QM. Get protocol specific data for PF update ramrod command.
269 qed_dcbx_process_tlv(struct qed_hwfn
*p_hwfn
,
270 struct qed_dcbx_results
*p_data
,
271 struct dcbx_app_priority_entry
*p_tbl
,
272 u32 pri_tc_tbl
, int count
, u8 dcbx_version
)
275 enum dcbx_protocol_type type
;
281 DP_VERBOSE(p_hwfn
, QED_MSG_DCB
, "Num APP entries = %d\n", count
);
283 ieee
= (dcbx_version
== DCBX_CONFIG_VERSION_IEEE
);
285 for (i
= 0; i
< count
; i
++) {
286 protocol_id
= QED_MFW_GET_FIELD(p_tbl
[i
].entry
,
287 DCBX_APP_PROTOCOL_ID
);
288 priority_map
= QED_MFW_GET_FIELD(p_tbl
[i
].entry
,
290 priority
= ffs(priority_map
) - 1;
292 DP_ERR(p_hwfn
, "Invalid priority\n");
296 tc
= QED_DCBX_PRIO2TC(pri_tc_tbl
, priority
);
297 if (qed_dcbx_get_app_protocol_type(p_hwfn
, p_tbl
[i
].entry
,
298 protocol_id
, &type
, ieee
)) {
299 /* ETH always have the enable bit reset, as it gets
300 * vlan information per packet. For other protocols,
301 * should be set according to the dcbx_enabled
302 * indication, but we only got here if there was an
303 * app tlv for the protocol, so dcbx must be enabled.
305 enable
= !(type
== DCBX_PROTOCOL_ETH
);
307 qed_dcbx_update_app_info(p_data
, p_hwfn
, enable
, true,
312 /* If RoCE-V2 TLV is not detected, driver need to use RoCE app
313 * data for RoCE-v2 not the default app data.
315 if (!p_data
->arr
[DCBX_PROTOCOL_ROCE_V2
].update
&&
316 p_data
->arr
[DCBX_PROTOCOL_ROCE
].update
) {
317 tc
= p_data
->arr
[DCBX_PROTOCOL_ROCE
].tc
;
318 priority
= p_data
->arr
[DCBX_PROTOCOL_ROCE
].priority
;
319 qed_dcbx_update_app_info(p_data
, p_hwfn
, true, true,
320 priority
, tc
, DCBX_PROTOCOL_ROCE_V2
);
323 /* Update ramrod protocol data and hw_info fields
324 * with default info when corresponding APP TLV's are not detected.
325 * The enabled field has a different logic for ethernet as only for
326 * ethernet dcb should disabled by default, as the information arrives
327 * from the OS (unless an explicit app tlv was present).
329 tc
= p_data
->arr
[DCBX_PROTOCOL_ETH
].tc
;
330 priority
= p_data
->arr
[DCBX_PROTOCOL_ETH
].priority
;
331 for (type
= 0; type
< DCBX_MAX_PROTOCOL_TYPE
; type
++) {
332 if (p_data
->arr
[type
].update
)
335 enable
= !(type
== DCBX_PROTOCOL_ETH
);
336 qed_dcbx_update_app_info(p_data
, p_hwfn
, enable
, true,
343 /* Parse app TLV's to update TC information in hw_info structure for
344 * reconfiguring QM. Get protocol specific data for PF update ramrod command.
346 static int qed_dcbx_process_mib_info(struct qed_hwfn
*p_hwfn
)
348 struct dcbx_app_priority_feature
*p_app
;
349 struct dcbx_app_priority_entry
*p_tbl
;
350 struct qed_dcbx_results data
= { 0 };
351 struct dcbx_ets_feature
*p_ets
;
352 struct qed_hw_info
*p_info
;
353 u32 pri_tc_tbl
, flags
;
358 flags
= p_hwfn
->p_dcbx_info
->operational
.flags
;
359 dcbx_version
= QED_MFW_GET_FIELD(flags
, DCBX_CONFIG_VERSION
);
361 p_app
= &p_hwfn
->p_dcbx_info
->operational
.features
.app
;
362 p_tbl
= p_app
->app_pri_tbl
;
364 p_ets
= &p_hwfn
->p_dcbx_info
->operational
.features
.ets
;
365 pri_tc_tbl
= p_ets
->pri_tc_tbl
[0];
367 p_info
= &p_hwfn
->hw_info
;
368 num_entries
= QED_MFW_GET_FIELD(p_app
->flags
, DCBX_APP_NUM_ENTRIES
);
370 rc
= qed_dcbx_process_tlv(p_hwfn
, &data
, p_tbl
, pri_tc_tbl
,
371 num_entries
, dcbx_version
);
375 p_info
->num_active_tc
= QED_MFW_GET_FIELD(p_ets
->flags
,
377 p_hwfn
->qm_info
.ooo_tc
= QED_MFW_GET_FIELD(p_ets
->flags
, DCBX_OOO_TC
);
378 data
.pf_id
= p_hwfn
->rel_pf_id
;
379 data
.dcbx_enabled
= !!dcbx_version
;
381 qed_dcbx_dp_protocol(p_hwfn
, &data
);
383 memcpy(&p_hwfn
->p_dcbx_info
->results
, &data
,
384 sizeof(struct qed_dcbx_results
));
390 qed_dcbx_copy_mib(struct qed_hwfn
*p_hwfn
,
391 struct qed_ptt
*p_ptt
,
392 struct qed_dcbx_mib_meta_data
*p_data
,
393 enum qed_mib_read_type type
)
395 u32 prefix_seq_num
, suffix_seq_num
;
399 /* The data is considered to be valid only if both sequence numbers are
403 if (type
== QED_DCBX_REMOTE_LLDP_MIB
) {
404 qed_memcpy_from(p_hwfn
, p_ptt
, p_data
->lldp_remote
,
405 p_data
->addr
, p_data
->size
);
406 prefix_seq_num
= p_data
->lldp_remote
->prefix_seq_num
;
407 suffix_seq_num
= p_data
->lldp_remote
->suffix_seq_num
;
409 qed_memcpy_from(p_hwfn
, p_ptt
, p_data
->mib
,
410 p_data
->addr
, p_data
->size
);
411 prefix_seq_num
= p_data
->mib
->prefix_seq_num
;
412 suffix_seq_num
= p_data
->mib
->suffix_seq_num
;
418 "mib type = %d, try count = %d prefix seq num = %d suffix seq num = %d\n",
419 type
, read_count
, prefix_seq_num
, suffix_seq_num
);
420 } while ((prefix_seq_num
!= suffix_seq_num
) &&
421 (read_count
< QED_DCBX_MAX_MIB_READ_TRY
));
423 if (read_count
>= QED_DCBX_MAX_MIB_READ_TRY
) {
425 "MIB read err, mib type = %d, try count = %d prefix seq num = %d suffix seq num = %d\n",
426 type
, read_count
, prefix_seq_num
, suffix_seq_num
);
434 qed_dcbx_get_priority_info(struct qed_hwfn
*p_hwfn
,
435 struct qed_dcbx_app_prio
*p_prio
,
436 struct qed_dcbx_results
*p_results
)
440 p_prio
->roce
= QED_DCBX_INVALID_PRIORITY
;
441 p_prio
->roce_v2
= QED_DCBX_INVALID_PRIORITY
;
442 p_prio
->iscsi
= QED_DCBX_INVALID_PRIORITY
;
443 p_prio
->fcoe
= QED_DCBX_INVALID_PRIORITY
;
445 if (p_results
->arr
[DCBX_PROTOCOL_ROCE
].update
&&
446 p_results
->arr
[DCBX_PROTOCOL_ROCE
].enable
)
447 p_prio
->roce
= p_results
->arr
[DCBX_PROTOCOL_ROCE
].priority
;
449 if (p_results
->arr
[DCBX_PROTOCOL_ROCE_V2
].update
&&
450 p_results
->arr
[DCBX_PROTOCOL_ROCE_V2
].enable
) {
451 val
= p_results
->arr
[DCBX_PROTOCOL_ROCE_V2
].priority
;
452 p_prio
->roce_v2
= val
;
455 if (p_results
->arr
[DCBX_PROTOCOL_ISCSI
].update
&&
456 p_results
->arr
[DCBX_PROTOCOL_ISCSI
].enable
)
457 p_prio
->iscsi
= p_results
->arr
[DCBX_PROTOCOL_ISCSI
].priority
;
459 if (p_results
->arr
[DCBX_PROTOCOL_FCOE
].update
&&
460 p_results
->arr
[DCBX_PROTOCOL_FCOE
].enable
)
461 p_prio
->fcoe
= p_results
->arr
[DCBX_PROTOCOL_FCOE
].priority
;
463 if (p_results
->arr
[DCBX_PROTOCOL_ETH
].update
&&
464 p_results
->arr
[DCBX_PROTOCOL_ETH
].enable
)
465 p_prio
->eth
= p_results
->arr
[DCBX_PROTOCOL_ETH
].priority
;
467 DP_VERBOSE(p_hwfn
, QED_MSG_DCB
,
468 "Priorities: iscsi %d, roce %d, roce v2 %d, fcoe %d, eth %d\n",
469 p_prio
->iscsi
, p_prio
->roce
, p_prio
->roce_v2
, p_prio
->fcoe
,
474 qed_dcbx_get_app_data(struct qed_hwfn
*p_hwfn
,
475 struct dcbx_app_priority_feature
*p_app
,
476 struct dcbx_app_priority_entry
*p_tbl
,
477 struct qed_dcbx_params
*p_params
, bool ieee
)
479 struct qed_app_entry
*entry
;
483 p_params
->app_willing
= QED_MFW_GET_FIELD(p_app
->flags
,
485 p_params
->app_valid
= QED_MFW_GET_FIELD(p_app
->flags
, DCBX_APP_ENABLED
);
486 p_params
->app_error
= QED_MFW_GET_FIELD(p_app
->flags
, DCBX_APP_ERROR
);
487 p_params
->num_app_entries
= QED_MFW_GET_FIELD(p_app
->flags
,
488 DCBX_APP_NUM_ENTRIES
);
489 for (i
= 0; i
< DCBX_MAX_APP_PROTOCOL
; i
++) {
490 entry
= &p_params
->app_entry
[i
];
495 sf_ieee
= QED_MFW_GET_FIELD(p_tbl
[i
].entry
,
498 case DCBX_APP_SF_IEEE_RESERVED
:
500 val
= QED_MFW_GET_FIELD(p_tbl
[i
].entry
,
502 entry
->sf_ieee
= val
?
503 QED_DCBX_SF_IEEE_TCP_UDP_PORT
:
504 QED_DCBX_SF_IEEE_ETHTYPE
;
506 case DCBX_APP_SF_IEEE_ETHTYPE
:
507 entry
->sf_ieee
= QED_DCBX_SF_IEEE_ETHTYPE
;
509 case DCBX_APP_SF_IEEE_TCP_PORT
:
510 entry
->sf_ieee
= QED_DCBX_SF_IEEE_TCP_PORT
;
512 case DCBX_APP_SF_IEEE_UDP_PORT
:
513 entry
->sf_ieee
= QED_DCBX_SF_IEEE_UDP_PORT
;
515 case DCBX_APP_SF_IEEE_TCP_UDP_PORT
:
516 entry
->sf_ieee
= QED_DCBX_SF_IEEE_TCP_UDP_PORT
;
520 entry
->ethtype
= !(QED_MFW_GET_FIELD(p_tbl
[i
].entry
,
524 pri_map
= QED_MFW_GET_FIELD(p_tbl
[i
].entry
, DCBX_APP_PRI_MAP
);
525 entry
->prio
= ffs(pri_map
) - 1;
526 entry
->proto_id
= QED_MFW_GET_FIELD(p_tbl
[i
].entry
,
527 DCBX_APP_PROTOCOL_ID
);
528 qed_dcbx_get_app_protocol_type(p_hwfn
, p_tbl
[i
].entry
,
530 &entry
->proto_type
, ieee
);
533 DP_VERBOSE(p_hwfn
, QED_MSG_DCB
,
534 "APP params: willing %d, valid %d error = %d\n",
535 p_params
->app_willing
, p_params
->app_valid
,
536 p_params
->app_error
);
540 qed_dcbx_get_pfc_data(struct qed_hwfn
*p_hwfn
,
541 u32 pfc
, struct qed_dcbx_params
*p_params
)
545 p_params
->pfc
.willing
= QED_MFW_GET_FIELD(pfc
, DCBX_PFC_WILLING
);
546 p_params
->pfc
.max_tc
= QED_MFW_GET_FIELD(pfc
, DCBX_PFC_CAPS
);
547 p_params
->pfc
.enabled
= QED_MFW_GET_FIELD(pfc
, DCBX_PFC_ENABLED
);
548 pfc_map
= QED_MFW_GET_FIELD(pfc
, DCBX_PFC_PRI_EN_BITMAP
);
549 p_params
->pfc
.prio
[0] = !!(pfc_map
& DCBX_PFC_PRI_EN_BITMAP_PRI_0
);
550 p_params
->pfc
.prio
[1] = !!(pfc_map
& DCBX_PFC_PRI_EN_BITMAP_PRI_1
);
551 p_params
->pfc
.prio
[2] = !!(pfc_map
& DCBX_PFC_PRI_EN_BITMAP_PRI_2
);
552 p_params
->pfc
.prio
[3] = !!(pfc_map
& DCBX_PFC_PRI_EN_BITMAP_PRI_3
);
553 p_params
->pfc
.prio
[4] = !!(pfc_map
& DCBX_PFC_PRI_EN_BITMAP_PRI_4
);
554 p_params
->pfc
.prio
[5] = !!(pfc_map
& DCBX_PFC_PRI_EN_BITMAP_PRI_5
);
555 p_params
->pfc
.prio
[6] = !!(pfc_map
& DCBX_PFC_PRI_EN_BITMAP_PRI_6
);
556 p_params
->pfc
.prio
[7] = !!(pfc_map
& DCBX_PFC_PRI_EN_BITMAP_PRI_7
);
558 DP_VERBOSE(p_hwfn
, QED_MSG_DCB
,
559 "PFC params: willing %d, pfc_bitmap %d\n",
560 p_params
->pfc
.willing
, pfc_map
);
564 qed_dcbx_get_ets_data(struct qed_hwfn
*p_hwfn
,
565 struct dcbx_ets_feature
*p_ets
,
566 struct qed_dcbx_params
*p_params
)
568 u32 bw_map
[2], tsa_map
[2], pri_map
;
571 p_params
->ets_willing
= QED_MFW_GET_FIELD(p_ets
->flags
,
573 p_params
->ets_enabled
= QED_MFW_GET_FIELD(p_ets
->flags
,
575 p_params
->ets_cbs
= QED_MFW_GET_FIELD(p_ets
->flags
, DCBX_ETS_CBS
);
576 p_params
->max_ets_tc
= QED_MFW_GET_FIELD(p_ets
->flags
,
578 DP_VERBOSE(p_hwfn
, QED_MSG_DCB
,
579 "ETS params: willing %d, ets_cbs %d pri_tc_tbl_0 %x max_ets_tc %d\n",
580 p_params
->ets_willing
,
582 p_ets
->pri_tc_tbl
[0], p_params
->max_ets_tc
);
584 if (p_params
->ets_enabled
&& !p_params
->max_ets_tc
) {
585 p_params
->max_ets_tc
= QED_MAX_PFC_PRIORITIES
;
586 DP_VERBOSE(p_hwfn
, QED_MSG_DCB
,
587 "ETS params: max_ets_tc is forced to %d\n",
588 p_params
->max_ets_tc
);
591 /* 8 bit tsa and bw data corresponding to each of the 8 TC's are
592 * encoded in a type u32 array of size 2.
594 bw_map
[0] = be32_to_cpu(p_ets
->tc_bw_tbl
[0]);
595 bw_map
[1] = be32_to_cpu(p_ets
->tc_bw_tbl
[1]);
596 tsa_map
[0] = be32_to_cpu(p_ets
->tc_tsa_tbl
[0]);
597 tsa_map
[1] = be32_to_cpu(p_ets
->tc_tsa_tbl
[1]);
598 pri_map
= p_ets
->pri_tc_tbl
[0];
599 for (i
= 0; i
< QED_MAX_PFC_PRIORITIES
; i
++) {
600 p_params
->ets_tc_bw_tbl
[i
] = ((u8
*)bw_map
)[i
];
601 p_params
->ets_tc_tsa_tbl
[i
] = ((u8
*)tsa_map
)[i
];
602 p_params
->ets_pri_tc_tbl
[i
] = QED_DCBX_PRIO2TC(pri_map
, i
);
603 DP_VERBOSE(p_hwfn
, QED_MSG_DCB
,
604 "elem %d bw_tbl %x tsa_tbl %x\n",
605 i
, p_params
->ets_tc_bw_tbl
[i
],
606 p_params
->ets_tc_tsa_tbl
[i
]);
611 qed_dcbx_get_common_params(struct qed_hwfn
*p_hwfn
,
612 struct dcbx_app_priority_feature
*p_app
,
613 struct dcbx_app_priority_entry
*p_tbl
,
614 struct dcbx_ets_feature
*p_ets
,
615 u32 pfc
, struct qed_dcbx_params
*p_params
, bool ieee
)
617 qed_dcbx_get_app_data(p_hwfn
, p_app
, p_tbl
, p_params
, ieee
);
618 qed_dcbx_get_ets_data(p_hwfn
, p_ets
, p_params
);
619 qed_dcbx_get_pfc_data(p_hwfn
, pfc
, p_params
);
623 qed_dcbx_get_local_params(struct qed_hwfn
*p_hwfn
,
624 struct qed_ptt
*p_ptt
, struct qed_dcbx_get
*params
)
626 struct dcbx_features
*p_feat
;
628 p_feat
= &p_hwfn
->p_dcbx_info
->local_admin
.features
;
629 qed_dcbx_get_common_params(p_hwfn
, &p_feat
->app
,
630 p_feat
->app
.app_pri_tbl
, &p_feat
->ets
,
631 p_feat
->pfc
, ¶ms
->local
.params
, false);
632 params
->local
.valid
= true;
636 qed_dcbx_get_remote_params(struct qed_hwfn
*p_hwfn
,
637 struct qed_ptt
*p_ptt
, struct qed_dcbx_get
*params
)
639 struct dcbx_features
*p_feat
;
641 p_feat
= &p_hwfn
->p_dcbx_info
->remote
.features
;
642 qed_dcbx_get_common_params(p_hwfn
, &p_feat
->app
,
643 p_feat
->app
.app_pri_tbl
, &p_feat
->ets
,
644 p_feat
->pfc
, ¶ms
->remote
.params
, false);
645 params
->remote
.valid
= true;
649 qed_dcbx_get_operational_params(struct qed_hwfn
*p_hwfn
,
650 struct qed_ptt
*p_ptt
,
651 struct qed_dcbx_get
*params
)
653 struct qed_dcbx_operational_params
*p_operational
;
654 struct qed_dcbx_results
*p_results
;
655 struct dcbx_features
*p_feat
;
660 flags
= p_hwfn
->p_dcbx_info
->operational
.flags
;
662 /* If DCBx version is non zero, then negotiation
663 * was successfuly performed
665 p_operational
= ¶ms
->operational
;
666 enabled
= !!(QED_MFW_GET_FIELD(flags
, DCBX_CONFIG_VERSION
) !=
667 DCBX_CONFIG_VERSION_DISABLED
);
669 p_operational
->enabled
= enabled
;
670 p_operational
->valid
= false;
674 p_feat
= &p_hwfn
->p_dcbx_info
->operational
.features
;
675 p_results
= &p_hwfn
->p_dcbx_info
->results
;
677 val
= !!(QED_MFW_GET_FIELD(flags
, DCBX_CONFIG_VERSION
) ==
678 DCBX_CONFIG_VERSION_IEEE
);
679 p_operational
->ieee
= val
;
680 val
= !!(QED_MFW_GET_FIELD(flags
, DCBX_CONFIG_VERSION
) ==
681 DCBX_CONFIG_VERSION_CEE
);
682 p_operational
->cee
= val
;
684 DP_VERBOSE(p_hwfn
, QED_MSG_DCB
, "Version support: ieee %d, cee %d\n",
685 p_operational
->ieee
, p_operational
->cee
);
687 qed_dcbx_get_common_params(p_hwfn
, &p_feat
->app
,
688 p_feat
->app
.app_pri_tbl
, &p_feat
->ets
,
689 p_feat
->pfc
, ¶ms
->operational
.params
,
690 p_operational
->ieee
);
691 qed_dcbx_get_priority_info(p_hwfn
, &p_operational
->app_prio
, p_results
);
692 err
= QED_MFW_GET_FIELD(p_feat
->app
.flags
, DCBX_APP_ERROR
);
693 p_operational
->err
= err
;
694 p_operational
->enabled
= enabled
;
695 p_operational
->valid
= true;
699 qed_dcbx_get_local_lldp_params(struct qed_hwfn
*p_hwfn
,
700 struct qed_ptt
*p_ptt
,
701 struct qed_dcbx_get
*params
)
703 struct lldp_config_params_s
*p_local
;
705 p_local
= &p_hwfn
->p_dcbx_info
->lldp_local
[LLDP_NEAREST_BRIDGE
];
707 memcpy(params
->lldp_local
.local_chassis_id
, p_local
->local_chassis_id
,
708 ARRAY_SIZE(p_local
->local_chassis_id
));
709 memcpy(params
->lldp_local
.local_port_id
, p_local
->local_port_id
,
710 ARRAY_SIZE(p_local
->local_port_id
));
714 qed_dcbx_get_remote_lldp_params(struct qed_hwfn
*p_hwfn
,
715 struct qed_ptt
*p_ptt
,
716 struct qed_dcbx_get
*params
)
718 struct lldp_status_params_s
*p_remote
;
720 p_remote
= &p_hwfn
->p_dcbx_info
->lldp_remote
[LLDP_NEAREST_BRIDGE
];
722 memcpy(params
->lldp_remote
.peer_chassis_id
, p_remote
->peer_chassis_id
,
723 ARRAY_SIZE(p_remote
->peer_chassis_id
));
724 memcpy(params
->lldp_remote
.peer_port_id
, p_remote
->peer_port_id
,
725 ARRAY_SIZE(p_remote
->peer_port_id
));
729 qed_dcbx_get_params(struct qed_hwfn
*p_hwfn
, struct qed_ptt
*p_ptt
,
730 struct qed_dcbx_get
*p_params
,
731 enum qed_mib_read_type type
)
734 case QED_DCBX_REMOTE_MIB
:
735 qed_dcbx_get_remote_params(p_hwfn
, p_ptt
, p_params
);
737 case QED_DCBX_LOCAL_MIB
:
738 qed_dcbx_get_local_params(p_hwfn
, p_ptt
, p_params
);
740 case QED_DCBX_OPERATIONAL_MIB
:
741 qed_dcbx_get_operational_params(p_hwfn
, p_ptt
, p_params
);
743 case QED_DCBX_REMOTE_LLDP_MIB
:
744 qed_dcbx_get_remote_lldp_params(p_hwfn
, p_ptt
, p_params
);
746 case QED_DCBX_LOCAL_LLDP_MIB
:
747 qed_dcbx_get_local_lldp_params(p_hwfn
, p_ptt
, p_params
);
750 DP_ERR(p_hwfn
, "MIB read err, unknown mib type %d\n", type
);
758 qed_dcbx_read_local_lldp_mib(struct qed_hwfn
*p_hwfn
, struct qed_ptt
*p_ptt
)
760 struct qed_dcbx_mib_meta_data data
;
763 memset(&data
, 0, sizeof(data
));
764 data
.addr
= p_hwfn
->mcp_info
->port_addr
+ offsetof(struct public_port
,
766 data
.lldp_local
= p_hwfn
->p_dcbx_info
->lldp_local
;
767 data
.size
= sizeof(struct lldp_config_params_s
);
768 qed_memcpy_from(p_hwfn
, p_ptt
, data
.lldp_local
, data
.addr
, data
.size
);
774 qed_dcbx_read_remote_lldp_mib(struct qed_hwfn
*p_hwfn
,
775 struct qed_ptt
*p_ptt
,
776 enum qed_mib_read_type type
)
778 struct qed_dcbx_mib_meta_data data
;
781 memset(&data
, 0, sizeof(data
));
782 data
.addr
= p_hwfn
->mcp_info
->port_addr
+ offsetof(struct public_port
,
784 data
.lldp_remote
= p_hwfn
->p_dcbx_info
->lldp_remote
;
785 data
.size
= sizeof(struct lldp_status_params_s
);
786 rc
= qed_dcbx_copy_mib(p_hwfn
, p_ptt
, &data
, type
);
792 qed_dcbx_read_operational_mib(struct qed_hwfn
*p_hwfn
,
793 struct qed_ptt
*p_ptt
,
794 enum qed_mib_read_type type
)
796 struct qed_dcbx_mib_meta_data data
;
799 memset(&data
, 0, sizeof(data
));
800 data
.addr
= p_hwfn
->mcp_info
->port_addr
+
801 offsetof(struct public_port
, operational_dcbx_mib
);
802 data
.mib
= &p_hwfn
->p_dcbx_info
->operational
;
803 data
.size
= sizeof(struct dcbx_mib
);
804 rc
= qed_dcbx_copy_mib(p_hwfn
, p_ptt
, &data
, type
);
810 qed_dcbx_read_remote_mib(struct qed_hwfn
*p_hwfn
,
811 struct qed_ptt
*p_ptt
, enum qed_mib_read_type type
)
813 struct qed_dcbx_mib_meta_data data
;
816 memset(&data
, 0, sizeof(data
));
817 data
.addr
= p_hwfn
->mcp_info
->port_addr
+
818 offsetof(struct public_port
, remote_dcbx_mib
);
819 data
.mib
= &p_hwfn
->p_dcbx_info
->remote
;
820 data
.size
= sizeof(struct dcbx_mib
);
821 rc
= qed_dcbx_copy_mib(p_hwfn
, p_ptt
, &data
, type
);
827 qed_dcbx_read_local_mib(struct qed_hwfn
*p_hwfn
, struct qed_ptt
*p_ptt
)
829 struct qed_dcbx_mib_meta_data data
;
832 memset(&data
, 0, sizeof(data
));
833 data
.addr
= p_hwfn
->mcp_info
->port_addr
+
834 offsetof(struct public_port
, local_admin_dcbx_mib
);
835 data
.local_admin
= &p_hwfn
->p_dcbx_info
->local_admin
;
836 data
.size
= sizeof(struct dcbx_local_params
);
837 qed_memcpy_from(p_hwfn
, p_ptt
, data
.local_admin
, data
.addr
, data
.size
);
842 static int qed_dcbx_read_mib(struct qed_hwfn
*p_hwfn
,
843 struct qed_ptt
*p_ptt
, enum qed_mib_read_type type
)
848 case QED_DCBX_OPERATIONAL_MIB
:
849 rc
= qed_dcbx_read_operational_mib(p_hwfn
, p_ptt
, type
);
851 case QED_DCBX_REMOTE_MIB
:
852 rc
= qed_dcbx_read_remote_mib(p_hwfn
, p_ptt
, type
);
854 case QED_DCBX_LOCAL_MIB
:
855 rc
= qed_dcbx_read_local_mib(p_hwfn
, p_ptt
);
857 case QED_DCBX_REMOTE_LLDP_MIB
:
858 rc
= qed_dcbx_read_remote_lldp_mib(p_hwfn
, p_ptt
, type
);
860 case QED_DCBX_LOCAL_LLDP_MIB
:
861 rc
= qed_dcbx_read_local_lldp_mib(p_hwfn
, p_ptt
);
864 DP_ERR(p_hwfn
, "MIB read err, unknown mib type %d\n", type
);
870 void qed_dcbx_aen(struct qed_hwfn
*hwfn
, u32 mib_type
)
872 struct qed_common_cb_ops
*op
= hwfn
->cdev
->protocol_ops
.common
;
873 void *cookie
= hwfn
->cdev
->ops_cookie
;
875 if (cookie
&& op
->dcbx_aen
)
876 op
->dcbx_aen(cookie
, &hwfn
->p_dcbx_info
->get
, mib_type
);
880 * Reconfigure QM and invoke PF update ramrod command if operational MIB
881 * change is detected.
884 qed_dcbx_mib_update_event(struct qed_hwfn
*p_hwfn
,
885 struct qed_ptt
*p_ptt
, enum qed_mib_read_type type
)
889 rc
= qed_dcbx_read_mib(p_hwfn
, p_ptt
, type
);
893 if (type
== QED_DCBX_OPERATIONAL_MIB
) {
894 rc
= qed_dcbx_process_mib_info(p_hwfn
);
896 /* reconfigure tcs of QM queues according
897 * to negotiation results
899 qed_qm_reconf(p_hwfn
, p_ptt
);
901 /* update storm FW with negotiation results */
902 qed_sp_pf_update(p_hwfn
);
905 qed_dcbx_get_params(p_hwfn
, p_ptt
, &p_hwfn
->p_dcbx_info
->get
, type
);
906 qed_dcbx_aen(p_hwfn
, type
);
911 int qed_dcbx_info_alloc(struct qed_hwfn
*p_hwfn
)
915 p_hwfn
->p_dcbx_info
= kzalloc(sizeof(*p_hwfn
->p_dcbx_info
), GFP_KERNEL
);
916 if (!p_hwfn
->p_dcbx_info
)
922 void qed_dcbx_info_free(struct qed_hwfn
*p_hwfn
,
923 struct qed_dcbx_info
*p_dcbx_info
)
925 kfree(p_hwfn
->p_dcbx_info
);
928 static void qed_dcbx_update_protocol_data(struct protocol_dcb_data
*p_data
,
929 struct qed_dcbx_results
*p_src
,
930 enum dcbx_protocol_type type
)
932 p_data
->dcb_enable_flag
= p_src
->arr
[type
].enable
;
933 p_data
->dcb_priority
= p_src
->arr
[type
].priority
;
934 p_data
->dcb_tc
= p_src
->arr
[type
].tc
;
937 /* Set pf update ramrod command params */
938 void qed_dcbx_set_pf_update_params(struct qed_dcbx_results
*p_src
,
939 struct pf_update_ramrod_data
*p_dest
)
941 struct protocol_dcb_data
*p_dcb_data
;
942 bool update_flag
= false;
944 p_dest
->pf_id
= p_src
->pf_id
;
946 update_flag
= p_src
->arr
[DCBX_PROTOCOL_FCOE
].update
;
947 p_dest
->update_fcoe_dcb_data_flag
= update_flag
;
949 update_flag
= p_src
->arr
[DCBX_PROTOCOL_ROCE
].update
;
950 p_dest
->update_roce_dcb_data_flag
= update_flag
;
951 update_flag
= p_src
->arr
[DCBX_PROTOCOL_ROCE_V2
].update
;
952 p_dest
->update_roce_dcb_data_flag
= update_flag
;
954 update_flag
= p_src
->arr
[DCBX_PROTOCOL_ISCSI
].update
;
955 p_dest
->update_iscsi_dcb_data_flag
= update_flag
;
956 update_flag
= p_src
->arr
[DCBX_PROTOCOL_ETH
].update
;
957 p_dest
->update_eth_dcb_data_flag
= update_flag
;
959 p_dcb_data
= &p_dest
->fcoe_dcb_data
;
960 qed_dcbx_update_protocol_data(p_dcb_data
, p_src
, DCBX_PROTOCOL_FCOE
);
961 p_dcb_data
= &p_dest
->roce_dcb_data
;
963 if (p_src
->arr
[DCBX_PROTOCOL_ROCE
].update
)
964 qed_dcbx_update_protocol_data(p_dcb_data
, p_src
,
966 if (p_src
->arr
[DCBX_PROTOCOL_ROCE_V2
].update
)
967 qed_dcbx_update_protocol_data(p_dcb_data
, p_src
,
968 DCBX_PROTOCOL_ROCE_V2
);
970 p_dcb_data
= &p_dest
->iscsi_dcb_data
;
971 qed_dcbx_update_protocol_data(p_dcb_data
, p_src
, DCBX_PROTOCOL_ISCSI
);
972 p_dcb_data
= &p_dest
->eth_dcb_data
;
973 qed_dcbx_update_protocol_data(p_dcb_data
, p_src
, DCBX_PROTOCOL_ETH
);
977 static int qed_dcbx_query_params(struct qed_hwfn
*p_hwfn
,
978 struct qed_dcbx_get
*p_get
,
979 enum qed_mib_read_type type
)
981 struct qed_ptt
*p_ptt
;
984 if (IS_VF(p_hwfn
->cdev
))
987 p_ptt
= qed_ptt_acquire(p_hwfn
);
991 rc
= qed_dcbx_read_mib(p_hwfn
, p_ptt
, type
);
995 rc
= qed_dcbx_get_params(p_hwfn
, p_ptt
, p_get
, type
);
998 qed_ptt_release(p_hwfn
, p_ptt
);
1003 qed_dcbx_set_pfc_data(struct qed_hwfn
*p_hwfn
,
1004 u32
*pfc
, struct qed_dcbx_params
*p_params
)
1009 *pfc
&= ~DCBX_PFC_ERROR_MASK
;
1011 if (p_params
->pfc
.willing
)
1012 *pfc
|= DCBX_PFC_WILLING_MASK
;
1014 *pfc
&= ~DCBX_PFC_WILLING_MASK
;
1016 if (p_params
->pfc
.enabled
)
1017 *pfc
|= DCBX_PFC_ENABLED_MASK
;
1019 *pfc
&= ~DCBX_PFC_ENABLED_MASK
;
1021 *pfc
&= ~DCBX_PFC_CAPS_MASK
;
1022 *pfc
|= (u32
)p_params
->pfc
.max_tc
<< DCBX_PFC_CAPS_SHIFT
;
1024 for (i
= 0; i
< QED_MAX_PFC_PRIORITIES
; i
++)
1025 if (p_params
->pfc
.prio
[i
])
1028 *pfc
&= ~DCBX_PFC_PRI_EN_BITMAP_MASK
;
1029 *pfc
|= (pfc_map
<< DCBX_PFC_PRI_EN_BITMAP_SHIFT
);
1031 DP_VERBOSE(p_hwfn
, QED_MSG_DCB
, "pfc = 0x%x\n", *pfc
);
1035 qed_dcbx_set_ets_data(struct qed_hwfn
*p_hwfn
,
1036 struct dcbx_ets_feature
*p_ets
,
1037 struct qed_dcbx_params
*p_params
)
1039 u8
*bw_map
, *tsa_map
;
1043 if (p_params
->ets_willing
)
1044 p_ets
->flags
|= DCBX_ETS_WILLING_MASK
;
1046 p_ets
->flags
&= ~DCBX_ETS_WILLING_MASK
;
1048 if (p_params
->ets_cbs
)
1049 p_ets
->flags
|= DCBX_ETS_CBS_MASK
;
1051 p_ets
->flags
&= ~DCBX_ETS_CBS_MASK
;
1053 if (p_params
->ets_enabled
)
1054 p_ets
->flags
|= DCBX_ETS_ENABLED_MASK
;
1056 p_ets
->flags
&= ~DCBX_ETS_ENABLED_MASK
;
1058 p_ets
->flags
&= ~DCBX_ETS_MAX_TCS_MASK
;
1059 p_ets
->flags
|= (u32
)p_params
->max_ets_tc
<< DCBX_ETS_MAX_TCS_SHIFT
;
1061 bw_map
= (u8
*)&p_ets
->tc_bw_tbl
[0];
1062 tsa_map
= (u8
*)&p_ets
->tc_tsa_tbl
[0];
1063 p_ets
->pri_tc_tbl
[0] = 0;
1064 for (i
= 0; i
< QED_MAX_PFC_PRIORITIES
; i
++) {
1065 bw_map
[i
] = p_params
->ets_tc_bw_tbl
[i
];
1066 tsa_map
[i
] = p_params
->ets_tc_tsa_tbl
[i
];
1067 /* Copy the priority value to the corresponding 4 bits in the
1068 * traffic class table.
1070 val
= (((u32
)p_params
->ets_pri_tc_tbl
[i
]) << ((7 - i
) * 4));
1071 p_ets
->pri_tc_tbl
[0] |= val
;
1073 for (i
= 0; i
< 2; i
++) {
1074 p_ets
->tc_bw_tbl
[i
] = cpu_to_be32(p_ets
->tc_bw_tbl
[i
]);
1075 p_ets
->tc_tsa_tbl
[i
] = cpu_to_be32(p_ets
->tc_tsa_tbl
[i
]);
1080 qed_dcbx_set_app_data(struct qed_hwfn
*p_hwfn
,
1081 struct dcbx_app_priority_feature
*p_app
,
1082 struct qed_dcbx_params
*p_params
, bool ieee
)
1087 if (p_params
->app_willing
)
1088 p_app
->flags
|= DCBX_APP_WILLING_MASK
;
1090 p_app
->flags
&= ~DCBX_APP_WILLING_MASK
;
1092 if (p_params
->app_valid
)
1093 p_app
->flags
|= DCBX_APP_ENABLED_MASK
;
1095 p_app
->flags
&= ~DCBX_APP_ENABLED_MASK
;
1097 p_app
->flags
&= ~DCBX_APP_NUM_ENTRIES_MASK
;
1098 p_app
->flags
|= (u32
)p_params
->num_app_entries
<<
1099 DCBX_APP_NUM_ENTRIES_SHIFT
;
1101 for (i
= 0; i
< DCBX_MAX_APP_PROTOCOL
; i
++) {
1102 entry
= &p_app
->app_pri_tbl
[i
].entry
;
1105 *entry
&= ~(DCBX_APP_SF_IEEE_MASK
| DCBX_APP_SF_MASK
);
1106 switch (p_params
->app_entry
[i
].sf_ieee
) {
1107 case QED_DCBX_SF_IEEE_ETHTYPE
:
1108 *entry
|= ((u32
)DCBX_APP_SF_IEEE_ETHTYPE
<<
1109 DCBX_APP_SF_IEEE_SHIFT
);
1110 *entry
|= ((u32
)DCBX_APP_SF_ETHTYPE
<<
1113 case QED_DCBX_SF_IEEE_TCP_PORT
:
1114 *entry
|= ((u32
)DCBX_APP_SF_IEEE_TCP_PORT
<<
1115 DCBX_APP_SF_IEEE_SHIFT
);
1116 *entry
|= ((u32
)DCBX_APP_SF_PORT
<<
1119 case QED_DCBX_SF_IEEE_UDP_PORT
:
1120 *entry
|= ((u32
)DCBX_APP_SF_IEEE_UDP_PORT
<<
1121 DCBX_APP_SF_IEEE_SHIFT
);
1122 *entry
|= ((u32
)DCBX_APP_SF_PORT
<<
1125 case QED_DCBX_SF_IEEE_TCP_UDP_PORT
:
1126 *entry
|= ((u32
)DCBX_APP_SF_IEEE_TCP_UDP_PORT
<<
1127 DCBX_APP_SF_IEEE_SHIFT
);
1128 *entry
|= ((u32
)DCBX_APP_SF_PORT
<<
1133 *entry
&= ~DCBX_APP_SF_MASK
;
1134 if (p_params
->app_entry
[i
].ethtype
)
1135 *entry
|= ((u32
)DCBX_APP_SF_ETHTYPE
<<
1138 *entry
|= ((u32
)DCBX_APP_SF_PORT
<<
1142 *entry
&= ~DCBX_APP_PROTOCOL_ID_MASK
;
1143 *entry
|= ((u32
)p_params
->app_entry
[i
].proto_id
<<
1144 DCBX_APP_PROTOCOL_ID_SHIFT
);
1145 *entry
&= ~DCBX_APP_PRI_MAP_MASK
;
1146 *entry
|= ((u32
)(p_params
->app_entry
[i
].prio
) <<
1147 DCBX_APP_PRI_MAP_SHIFT
);
1152 qed_dcbx_set_local_params(struct qed_hwfn
*p_hwfn
,
1153 struct dcbx_local_params
*local_admin
,
1154 struct qed_dcbx_set
*params
)
1158 local_admin
->flags
= 0;
1159 memcpy(&local_admin
->features
,
1160 &p_hwfn
->p_dcbx_info
->operational
.features
,
1161 sizeof(local_admin
->features
));
1163 if (params
->enabled
) {
1164 local_admin
->config
= params
->ver_num
;
1165 ieee
= !!(params
->ver_num
& DCBX_CONFIG_VERSION_IEEE
);
1167 local_admin
->config
= DCBX_CONFIG_VERSION_DISABLED
;
1170 if (params
->override_flags
& QED_DCBX_OVERRIDE_PFC_CFG
)
1171 qed_dcbx_set_pfc_data(p_hwfn
, &local_admin
->features
.pfc
,
1172 ¶ms
->config
.params
);
1174 if (params
->override_flags
& QED_DCBX_OVERRIDE_ETS_CFG
)
1175 qed_dcbx_set_ets_data(p_hwfn
, &local_admin
->features
.ets
,
1176 ¶ms
->config
.params
);
1178 if (params
->override_flags
& QED_DCBX_OVERRIDE_APP_CFG
)
1179 qed_dcbx_set_app_data(p_hwfn
, &local_admin
->features
.app
,
1180 ¶ms
->config
.params
, ieee
);
1183 int qed_dcbx_config_params(struct qed_hwfn
*p_hwfn
, struct qed_ptt
*p_ptt
,
1184 struct qed_dcbx_set
*params
, bool hw_commit
)
1186 struct dcbx_local_params local_admin
;
1187 struct qed_dcbx_mib_meta_data data
;
1188 u32 resp
= 0, param
= 0;
1192 memcpy(&p_hwfn
->p_dcbx_info
->set
, params
,
1193 sizeof(struct qed_dcbx_set
));
1197 /* clear set-parmas cache */
1198 memset(&p_hwfn
->p_dcbx_info
->set
, 0, sizeof(p_hwfn
->p_dcbx_info
->set
));
1200 memset(&local_admin
, 0, sizeof(local_admin
));
1201 qed_dcbx_set_local_params(p_hwfn
, &local_admin
, params
);
1203 data
.addr
= p_hwfn
->mcp_info
->port_addr
+
1204 offsetof(struct public_port
, local_admin_dcbx_mib
);
1205 data
.local_admin
= &local_admin
;
1206 data
.size
= sizeof(struct dcbx_local_params
);
1207 qed_memcpy_to(p_hwfn
, p_ptt
, data
.addr
, data
.local_admin
, data
.size
);
1209 rc
= qed_mcp_cmd(p_hwfn
, p_ptt
, DRV_MSG_CODE_SET_DCBX
,
1210 1 << DRV_MB_PARAM_LLDP_SEND_SHIFT
, &resp
, ¶m
);
1212 DP_NOTICE(p_hwfn
, "Failed to send DCBX update request\n");
1217 int qed_dcbx_get_config_params(struct qed_hwfn
*p_hwfn
,
1218 struct qed_dcbx_set
*params
)
1220 struct qed_dcbx_get
*dcbx_info
;
1223 if (p_hwfn
->p_dcbx_info
->set
.config
.valid
) {
1224 memcpy(params
, &p_hwfn
->p_dcbx_info
->set
,
1225 sizeof(struct qed_dcbx_set
));
1229 dcbx_info
= kzalloc(sizeof(*dcbx_info
), GFP_KERNEL
);
1233 memset(dcbx_info
, 0, sizeof(*dcbx_info
));
1234 rc
= qed_dcbx_query_params(p_hwfn
, dcbx_info
, QED_DCBX_OPERATIONAL_MIB
);
1240 p_hwfn
->p_dcbx_info
->set
.override_flags
= 0;
1241 p_hwfn
->p_dcbx_info
->set
.ver_num
= DCBX_CONFIG_VERSION_DISABLED
;
1242 if (dcbx_info
->operational
.cee
)
1243 p_hwfn
->p_dcbx_info
->set
.ver_num
|= DCBX_CONFIG_VERSION_CEE
;
1244 if (dcbx_info
->operational
.ieee
)
1245 p_hwfn
->p_dcbx_info
->set
.ver_num
|= DCBX_CONFIG_VERSION_IEEE
;
1247 p_hwfn
->p_dcbx_info
->set
.enabled
= dcbx_info
->operational
.enabled
;
1248 memcpy(&p_hwfn
->p_dcbx_info
->set
.config
.params
,
1249 &dcbx_info
->operational
.params
,
1250 sizeof(struct qed_dcbx_admin_params
));
1251 p_hwfn
->p_dcbx_info
->set
.config
.valid
= true;
1253 memcpy(params
, &p_hwfn
->p_dcbx_info
->set
, sizeof(struct qed_dcbx_set
));
1260 static struct qed_dcbx_get
*qed_dcbnl_get_dcbx(struct qed_hwfn
*hwfn
,
1261 enum qed_mib_read_type type
)
1263 struct qed_dcbx_get
*dcbx_info
;
1265 dcbx_info
= kmalloc(sizeof(*dcbx_info
), GFP_ATOMIC
);
1269 memset(dcbx_info
, 0, sizeof(*dcbx_info
));
1270 if (qed_dcbx_query_params(hwfn
, dcbx_info
, type
)) {
1275 if ((type
== QED_DCBX_OPERATIONAL_MIB
) &&
1276 !dcbx_info
->operational
.enabled
) {
1277 DP_INFO(hwfn
, "DCBX is not enabled/operational\n");
1285 static u8
qed_dcbnl_getstate(struct qed_dev
*cdev
)
1287 struct qed_hwfn
*hwfn
= QED_LEADING_HWFN(cdev
);
1288 struct qed_dcbx_get
*dcbx_info
;
1291 dcbx_info
= qed_dcbnl_get_dcbx(hwfn
, QED_DCBX_OPERATIONAL_MIB
);
1295 enabled
= dcbx_info
->operational
.enabled
;
1296 DP_VERBOSE(hwfn
, QED_MSG_DCB
, "DCB state = %d\n", enabled
);
1302 static u8
qed_dcbnl_setstate(struct qed_dev
*cdev
, u8 state
)
1304 struct qed_hwfn
*hwfn
= QED_LEADING_HWFN(cdev
);
1305 struct qed_dcbx_set dcbx_set
;
1306 struct qed_ptt
*ptt
;
1309 DP_VERBOSE(hwfn
, QED_MSG_DCB
, "DCB state = %d\n", state
);
1311 memset(&dcbx_set
, 0, sizeof(dcbx_set
));
1312 rc
= qed_dcbx_get_config_params(hwfn
, &dcbx_set
);
1316 dcbx_set
.enabled
= !!state
;
1318 ptt
= qed_ptt_acquire(hwfn
);
1322 rc
= qed_dcbx_config_params(hwfn
, ptt
, &dcbx_set
, 0);
1324 qed_ptt_release(hwfn
, ptt
);
1329 static void qed_dcbnl_getpgtccfgtx(struct qed_dev
*cdev
, int tc
, u8
*prio_type
,
1330 u8
*pgid
, u8
*bw_pct
, u8
*up_map
)
1332 struct qed_hwfn
*hwfn
= QED_LEADING_HWFN(cdev
);
1333 struct qed_dcbx_get
*dcbx_info
;
1335 DP_VERBOSE(hwfn
, QED_MSG_DCB
, "tc = %d\n", tc
);
1336 *prio_type
= *pgid
= *bw_pct
= *up_map
= 0;
1337 if (tc
< 0 || tc
>= QED_MAX_PFC_PRIORITIES
) {
1338 DP_INFO(hwfn
, "Invalid tc %d\n", tc
);
1342 dcbx_info
= qed_dcbnl_get_dcbx(hwfn
, QED_DCBX_OPERATIONAL_MIB
);
1346 *pgid
= dcbx_info
->operational
.params
.ets_pri_tc_tbl
[tc
];
1350 static void qed_dcbnl_getpgbwgcfgtx(struct qed_dev
*cdev
, int pgid
, u8
*bw_pct
)
1352 struct qed_hwfn
*hwfn
= QED_LEADING_HWFN(cdev
);
1353 struct qed_dcbx_get
*dcbx_info
;
1356 DP_VERBOSE(hwfn
, QED_MSG_DCB
, "pgid = %d\n", pgid
);
1357 if (pgid
< 0 || pgid
>= QED_MAX_PFC_PRIORITIES
) {
1358 DP_INFO(hwfn
, "Invalid pgid %d\n", pgid
);
1362 dcbx_info
= qed_dcbnl_get_dcbx(hwfn
, QED_DCBX_OPERATIONAL_MIB
);
1366 *bw_pct
= dcbx_info
->operational
.params
.ets_tc_bw_tbl
[pgid
];
1367 DP_VERBOSE(hwfn
, QED_MSG_DCB
, "bw_pct = %d\n", *bw_pct
);
1371 static void qed_dcbnl_getpgtccfgrx(struct qed_dev
*cdev
, int tc
, u8
*prio
,
1372 u8
*bwg_id
, u8
*bw_pct
, u8
*up_map
)
1374 DP_INFO(QED_LEADING_HWFN(cdev
), "Rx ETS is not supported\n");
1375 *prio
= *bwg_id
= *bw_pct
= *up_map
= 0;
1378 static void qed_dcbnl_getpgbwgcfgrx(struct qed_dev
*cdev
,
1379 int bwg_id
, u8
*bw_pct
)
1381 DP_INFO(QED_LEADING_HWFN(cdev
), "Rx ETS is not supported\n");
1385 static void qed_dcbnl_getpfccfg(struct qed_dev
*cdev
,
1386 int priority
, u8
*setting
)
1388 struct qed_hwfn
*hwfn
= QED_LEADING_HWFN(cdev
);
1389 struct qed_dcbx_get
*dcbx_info
;
1391 DP_VERBOSE(hwfn
, QED_MSG_DCB
, "priority = %d\n", priority
);
1392 if (priority
< 0 || priority
>= QED_MAX_PFC_PRIORITIES
) {
1393 DP_INFO(hwfn
, "Invalid priority %d\n", priority
);
1397 dcbx_info
= qed_dcbnl_get_dcbx(hwfn
, QED_DCBX_OPERATIONAL_MIB
);
1401 *setting
= dcbx_info
->operational
.params
.pfc
.prio
[priority
];
1402 DP_VERBOSE(hwfn
, QED_MSG_DCB
, "setting = %d\n", *setting
);
1406 static void qed_dcbnl_setpfccfg(struct qed_dev
*cdev
, int priority
, u8 setting
)
1408 struct qed_hwfn
*hwfn
= QED_LEADING_HWFN(cdev
);
1409 struct qed_dcbx_set dcbx_set
;
1410 struct qed_ptt
*ptt
;
1413 DP_VERBOSE(hwfn
, QED_MSG_DCB
, "priority = %d setting = %d\n",
1415 if (priority
< 0 || priority
>= QED_MAX_PFC_PRIORITIES
) {
1416 DP_INFO(hwfn
, "Invalid priority %d\n", priority
);
1420 memset(&dcbx_set
, 0, sizeof(dcbx_set
));
1421 rc
= qed_dcbx_get_config_params(hwfn
, &dcbx_set
);
1425 dcbx_set
.override_flags
|= QED_DCBX_OVERRIDE_PFC_CFG
;
1426 dcbx_set
.config
.params
.pfc
.prio
[priority
] = !!setting
;
1428 ptt
= qed_ptt_acquire(hwfn
);
1432 rc
= qed_dcbx_config_params(hwfn
, ptt
, &dcbx_set
, 0);
1434 qed_ptt_release(hwfn
, ptt
);
1437 static u8
qed_dcbnl_getcap(struct qed_dev
*cdev
, int capid
, u8
*cap
)
1439 struct qed_hwfn
*hwfn
= QED_LEADING_HWFN(cdev
);
1440 struct qed_dcbx_get
*dcbx_info
;
1443 DP_VERBOSE(hwfn
, QED_MSG_DCB
, "capid = %d\n", capid
);
1444 dcbx_info
= qed_dcbnl_get_dcbx(hwfn
, QED_DCBX_OPERATIONAL_MIB
);
1449 case DCB_CAP_ATTR_PG
:
1450 case DCB_CAP_ATTR_PFC
:
1451 case DCB_CAP_ATTR_UP2TC
:
1452 case DCB_CAP_ATTR_GSP
:
1455 case DCB_CAP_ATTR_PG_TCS
:
1456 case DCB_CAP_ATTR_PFC_TCS
:
1459 case DCB_CAP_ATTR_DCBX
:
1460 *cap
= (DCB_CAP_DCBX_LLD_MANAGED
| DCB_CAP_DCBX_VER_CEE
|
1461 DCB_CAP_DCBX_VER_IEEE
);
1468 DP_VERBOSE(hwfn
, QED_MSG_DCB
, "id = %d caps = %d\n", capid
, *cap
);
1474 static int qed_dcbnl_getnumtcs(struct qed_dev
*cdev
, int tcid
, u8
*num
)
1476 struct qed_hwfn
*hwfn
= QED_LEADING_HWFN(cdev
);
1477 struct qed_dcbx_get
*dcbx_info
;
1480 DP_VERBOSE(hwfn
, QED_MSG_DCB
, "tcid = %d\n", tcid
);
1481 dcbx_info
= qed_dcbnl_get_dcbx(hwfn
, QED_DCBX_OPERATIONAL_MIB
);
1486 case DCB_NUMTCS_ATTR_PG
:
1487 *num
= dcbx_info
->operational
.params
.max_ets_tc
;
1489 case DCB_NUMTCS_ATTR_PFC
:
1490 *num
= dcbx_info
->operational
.params
.pfc
.max_tc
;
1497 DP_VERBOSE(hwfn
, QED_MSG_DCB
, "numtcs = %d\n", *num
);
1502 static u8
qed_dcbnl_getpfcstate(struct qed_dev
*cdev
)
1504 struct qed_hwfn
*hwfn
= QED_LEADING_HWFN(cdev
);
1505 struct qed_dcbx_get
*dcbx_info
;
1508 dcbx_info
= qed_dcbnl_get_dcbx(hwfn
, QED_DCBX_OPERATIONAL_MIB
);
1512 enabled
= dcbx_info
->operational
.params
.pfc
.enabled
;
1513 DP_VERBOSE(hwfn
, QED_MSG_DCB
, "pfc state = %d\n", enabled
);
1519 static u8
qed_dcbnl_getdcbx(struct qed_dev
*cdev
)
1521 struct qed_hwfn
*hwfn
= QED_LEADING_HWFN(cdev
);
1522 struct qed_dcbx_get
*dcbx_info
;
1525 dcbx_info
= qed_dcbnl_get_dcbx(hwfn
, QED_DCBX_OPERATIONAL_MIB
);
1529 if (dcbx_info
->operational
.enabled
)
1530 mode
|= DCB_CAP_DCBX_LLD_MANAGED
;
1531 if (dcbx_info
->operational
.ieee
)
1532 mode
|= DCB_CAP_DCBX_VER_IEEE
;
1533 if (dcbx_info
->operational
.cee
)
1534 mode
|= DCB_CAP_DCBX_VER_CEE
;
1536 DP_VERBOSE(hwfn
, QED_MSG_DCB
, "dcb mode = %d\n", mode
);
1542 static void qed_dcbnl_setpgtccfgtx(struct qed_dev
*cdev
,
1544 u8 pri_type
, u8 pgid
, u8 bw_pct
, u8 up_map
)
1546 struct qed_hwfn
*hwfn
= QED_LEADING_HWFN(cdev
);
1547 struct qed_dcbx_set dcbx_set
;
1548 struct qed_ptt
*ptt
;
1551 DP_VERBOSE(hwfn
, QED_MSG_DCB
,
1552 "tc = %d pri_type = %d pgid = %d bw_pct = %d up_map = %d\n",
1553 tc
, pri_type
, pgid
, bw_pct
, up_map
);
1555 if (tc
< 0 || tc
>= QED_MAX_PFC_PRIORITIES
) {
1556 DP_INFO(hwfn
, "Invalid tc %d\n", tc
);
1560 memset(&dcbx_set
, 0, sizeof(dcbx_set
));
1561 rc
= qed_dcbx_get_config_params(hwfn
, &dcbx_set
);
1565 dcbx_set
.override_flags
|= QED_DCBX_OVERRIDE_ETS_CFG
;
1566 dcbx_set
.config
.params
.ets_pri_tc_tbl
[tc
] = pgid
;
1568 ptt
= qed_ptt_acquire(hwfn
);
1572 rc
= qed_dcbx_config_params(hwfn
, ptt
, &dcbx_set
, 0);
1574 qed_ptt_release(hwfn
, ptt
);
1577 static void qed_dcbnl_setpgtccfgrx(struct qed_dev
*cdev
, int prio
,
1578 u8 pri_type
, u8 pgid
, u8 bw_pct
, u8 up_map
)
1580 DP_INFO(QED_LEADING_HWFN(cdev
), "Rx ETS is not supported\n");
1583 static void qed_dcbnl_setpgbwgcfgtx(struct qed_dev
*cdev
, int pgid
, u8 bw_pct
)
1585 struct qed_hwfn
*hwfn
= QED_LEADING_HWFN(cdev
);
1586 struct qed_dcbx_set dcbx_set
;
1587 struct qed_ptt
*ptt
;
1590 DP_VERBOSE(hwfn
, QED_MSG_DCB
, "pgid = %d bw_pct = %d\n", pgid
, bw_pct
);
1591 if (pgid
< 0 || pgid
>= QED_MAX_PFC_PRIORITIES
) {
1592 DP_INFO(hwfn
, "Invalid pgid %d\n", pgid
);
1596 memset(&dcbx_set
, 0, sizeof(dcbx_set
));
1597 rc
= qed_dcbx_get_config_params(hwfn
, &dcbx_set
);
1601 dcbx_set
.override_flags
|= QED_DCBX_OVERRIDE_ETS_CFG
;
1602 dcbx_set
.config
.params
.ets_tc_bw_tbl
[pgid
] = bw_pct
;
1604 ptt
= qed_ptt_acquire(hwfn
);
1608 rc
= qed_dcbx_config_params(hwfn
, ptt
, &dcbx_set
, 0);
1610 qed_ptt_release(hwfn
, ptt
);
1613 static void qed_dcbnl_setpgbwgcfgrx(struct qed_dev
*cdev
, int pgid
, u8 bw_pct
)
1615 DP_INFO(QED_LEADING_HWFN(cdev
), "Rx ETS is not supported\n");
1618 static u8
qed_dcbnl_setall(struct qed_dev
*cdev
)
1620 struct qed_hwfn
*hwfn
= QED_LEADING_HWFN(cdev
);
1621 struct qed_dcbx_set dcbx_set
;
1622 struct qed_ptt
*ptt
;
1625 memset(&dcbx_set
, 0, sizeof(dcbx_set
));
1626 rc
= qed_dcbx_get_config_params(hwfn
, &dcbx_set
);
1630 ptt
= qed_ptt_acquire(hwfn
);
1634 rc
= qed_dcbx_config_params(hwfn
, ptt
, &dcbx_set
, 1);
1636 qed_ptt_release(hwfn
, ptt
);
1641 static int qed_dcbnl_setnumtcs(struct qed_dev
*cdev
, int tcid
, u8 num
)
1643 struct qed_hwfn
*hwfn
= QED_LEADING_HWFN(cdev
);
1644 struct qed_dcbx_set dcbx_set
;
1645 struct qed_ptt
*ptt
;
1648 DP_VERBOSE(hwfn
, QED_MSG_DCB
, "tcid = %d num = %d\n", tcid
, num
);
1649 memset(&dcbx_set
, 0, sizeof(dcbx_set
));
1650 rc
= qed_dcbx_get_config_params(hwfn
, &dcbx_set
);
1655 case DCB_NUMTCS_ATTR_PG
:
1656 dcbx_set
.override_flags
|= QED_DCBX_OVERRIDE_ETS_CFG
;
1657 dcbx_set
.config
.params
.max_ets_tc
= num
;
1659 case DCB_NUMTCS_ATTR_PFC
:
1660 dcbx_set
.override_flags
|= QED_DCBX_OVERRIDE_PFC_CFG
;
1661 dcbx_set
.config
.params
.pfc
.max_tc
= num
;
1664 DP_INFO(hwfn
, "Invalid tcid %d\n", tcid
);
1668 ptt
= qed_ptt_acquire(hwfn
);
1672 rc
= qed_dcbx_config_params(hwfn
, ptt
, &dcbx_set
, 0);
1674 qed_ptt_release(hwfn
, ptt
);
1679 static void qed_dcbnl_setpfcstate(struct qed_dev
*cdev
, u8 state
)
1681 struct qed_hwfn
*hwfn
= QED_LEADING_HWFN(cdev
);
1682 struct qed_dcbx_set dcbx_set
;
1683 struct qed_ptt
*ptt
;
1686 DP_VERBOSE(hwfn
, QED_MSG_DCB
, "new state = %d\n", state
);
1688 memset(&dcbx_set
, 0, sizeof(dcbx_set
));
1689 rc
= qed_dcbx_get_config_params(hwfn
, &dcbx_set
);
1693 dcbx_set
.override_flags
|= QED_DCBX_OVERRIDE_PFC_CFG
;
1694 dcbx_set
.config
.params
.pfc
.enabled
= !!state
;
1696 ptt
= qed_ptt_acquire(hwfn
);
1700 rc
= qed_dcbx_config_params(hwfn
, ptt
, &dcbx_set
, 0);
1702 qed_ptt_release(hwfn
, ptt
);
1705 static int qed_dcbnl_getapp(struct qed_dev
*cdev
, u8 idtype
, u16 idval
)
1707 struct qed_hwfn
*hwfn
= QED_LEADING_HWFN(cdev
);
1708 struct qed_dcbx_get
*dcbx_info
;
1709 struct qed_app_entry
*entry
;
1714 dcbx_info
= qed_dcbnl_get_dcbx(hwfn
, QED_DCBX_OPERATIONAL_MIB
);
1718 ethtype
= !!(idtype
== DCB_APP_IDTYPE_ETHTYPE
);
1719 for (i
= 0; i
< QED_DCBX_MAX_APP_PROTOCOL
; i
++) {
1720 entry
= &dcbx_info
->operational
.params
.app_entry
[i
];
1721 if ((entry
->ethtype
== ethtype
) && (entry
->proto_id
== idval
)) {
1727 if (i
== QED_DCBX_MAX_APP_PROTOCOL
) {
1728 DP_ERR(cdev
, "App entry (%d, %d) not found\n", idtype
, idval
);
1738 static int qed_dcbnl_setapp(struct qed_dev
*cdev
,
1739 u8 idtype
, u16 idval
, u8 pri_map
)
1741 struct qed_hwfn
*hwfn
= QED_LEADING_HWFN(cdev
);
1742 struct qed_dcbx_set dcbx_set
;
1743 struct qed_app_entry
*entry
;
1744 struct qed_ptt
*ptt
;
1748 memset(&dcbx_set
, 0, sizeof(dcbx_set
));
1749 rc
= qed_dcbx_get_config_params(hwfn
, &dcbx_set
);
1753 ethtype
= !!(idtype
== DCB_APP_IDTYPE_ETHTYPE
);
1754 for (i
= 0; i
< QED_DCBX_MAX_APP_PROTOCOL
; i
++) {
1755 entry
= &dcbx_set
.config
.params
.app_entry
[i
];
1756 if ((entry
->ethtype
== ethtype
) && (entry
->proto_id
== idval
))
1758 /* First empty slot */
1759 if (!entry
->proto_id
) {
1760 dcbx_set
.config
.params
.num_app_entries
++;
1765 if (i
== QED_DCBX_MAX_APP_PROTOCOL
) {
1766 DP_ERR(cdev
, "App table is full\n");
1770 dcbx_set
.override_flags
|= QED_DCBX_OVERRIDE_APP_CFG
;
1771 dcbx_set
.config
.params
.app_entry
[i
].ethtype
= ethtype
;
1772 dcbx_set
.config
.params
.app_entry
[i
].proto_id
= idval
;
1773 dcbx_set
.config
.params
.app_entry
[i
].prio
= pri_map
;
1775 ptt
= qed_ptt_acquire(hwfn
);
1779 rc
= qed_dcbx_config_params(hwfn
, ptt
, &dcbx_set
, 0);
1781 qed_ptt_release(hwfn
, ptt
);
1786 static u8
qed_dcbnl_setdcbx(struct qed_dev
*cdev
, u8 mode
)
1788 struct qed_hwfn
*hwfn
= QED_LEADING_HWFN(cdev
);
1789 struct qed_dcbx_set dcbx_set
;
1790 struct qed_ptt
*ptt
;
1793 DP_VERBOSE(hwfn
, QED_MSG_DCB
, "new mode = %x\n", mode
);
1795 if (!(mode
& DCB_CAP_DCBX_VER_IEEE
) && !(mode
& DCB_CAP_DCBX_VER_CEE
)) {
1796 DP_INFO(hwfn
, "Allowed mode is cee, ieee or both\n");
1800 memset(&dcbx_set
, 0, sizeof(dcbx_set
));
1801 rc
= qed_dcbx_get_config_params(hwfn
, &dcbx_set
);
1805 dcbx_set
.ver_num
= 0;
1806 if (mode
& DCB_CAP_DCBX_VER_CEE
) {
1807 dcbx_set
.ver_num
|= DCBX_CONFIG_VERSION_CEE
;
1808 dcbx_set
.enabled
= true;
1811 if (mode
& DCB_CAP_DCBX_VER_IEEE
) {
1812 dcbx_set
.ver_num
|= DCBX_CONFIG_VERSION_IEEE
;
1813 dcbx_set
.enabled
= true;
1816 ptt
= qed_ptt_acquire(hwfn
);
1820 rc
= qed_dcbx_config_params(hwfn
, ptt
, &dcbx_set
, 0);
1822 qed_ptt_release(hwfn
, ptt
);
1827 static u8
qed_dcbnl_getfeatcfg(struct qed_dev
*cdev
, int featid
, u8
*flags
)
1829 struct qed_hwfn
*hwfn
= QED_LEADING_HWFN(cdev
);
1830 struct qed_dcbx_get
*dcbx_info
;
1832 DP_VERBOSE(hwfn
, QED_MSG_DCB
, "Feature id = %d\n", featid
);
1833 dcbx_info
= qed_dcbnl_get_dcbx(hwfn
, QED_DCBX_OPERATIONAL_MIB
);
1839 case DCB_FEATCFG_ATTR_PG
:
1840 if (dcbx_info
->operational
.params
.ets_enabled
)
1841 *flags
= DCB_FEATCFG_ENABLE
;
1843 *flags
= DCB_FEATCFG_ERROR
;
1845 case DCB_FEATCFG_ATTR_PFC
:
1846 if (dcbx_info
->operational
.params
.pfc
.enabled
)
1847 *flags
= DCB_FEATCFG_ENABLE
;
1849 *flags
= DCB_FEATCFG_ERROR
;
1851 case DCB_FEATCFG_ATTR_APP
:
1852 if (dcbx_info
->operational
.params
.app_valid
)
1853 *flags
= DCB_FEATCFG_ENABLE
;
1855 *flags
= DCB_FEATCFG_ERROR
;
1858 DP_INFO(hwfn
, "Invalid feature-ID %d\n", featid
);
1863 DP_VERBOSE(hwfn
, QED_MSG_DCB
, "flags = %d\n", *flags
);
1869 static u8
qed_dcbnl_setfeatcfg(struct qed_dev
*cdev
, int featid
, u8 flags
)
1871 struct qed_hwfn
*hwfn
= QED_LEADING_HWFN(cdev
);
1872 struct qed_dcbx_set dcbx_set
;
1873 bool enabled
, willing
;
1874 struct qed_ptt
*ptt
;
1877 DP_VERBOSE(hwfn
, QED_MSG_DCB
, "featid = %d flags = %d\n",
1879 memset(&dcbx_set
, 0, sizeof(dcbx_set
));
1880 rc
= qed_dcbx_get_config_params(hwfn
, &dcbx_set
);
1884 enabled
= !!(flags
& DCB_FEATCFG_ENABLE
);
1885 willing
= !!(flags
& DCB_FEATCFG_WILLING
);
1887 case DCB_FEATCFG_ATTR_PG
:
1888 dcbx_set
.override_flags
|= QED_DCBX_OVERRIDE_ETS_CFG
;
1889 dcbx_set
.config
.params
.ets_enabled
= enabled
;
1890 dcbx_set
.config
.params
.ets_willing
= willing
;
1892 case DCB_FEATCFG_ATTR_PFC
:
1893 dcbx_set
.override_flags
|= QED_DCBX_OVERRIDE_PFC_CFG
;
1894 dcbx_set
.config
.params
.pfc
.enabled
= enabled
;
1895 dcbx_set
.config
.params
.pfc
.willing
= willing
;
1897 case DCB_FEATCFG_ATTR_APP
:
1898 dcbx_set
.override_flags
|= QED_DCBX_OVERRIDE_APP_CFG
;
1899 dcbx_set
.config
.params
.app_willing
= willing
;
1902 DP_INFO(hwfn
, "Invalid feature-ID %d\n", featid
);
1906 ptt
= qed_ptt_acquire(hwfn
);
1910 rc
= qed_dcbx_config_params(hwfn
, ptt
, &dcbx_set
, 0);
1912 qed_ptt_release(hwfn
, ptt
);
1917 static int qed_dcbnl_peer_getappinfo(struct qed_dev
*cdev
,
1918 struct dcb_peer_app_info
*info
,
1921 struct qed_hwfn
*hwfn
= QED_LEADING_HWFN(cdev
);
1922 struct qed_dcbx_get
*dcbx_info
;
1924 dcbx_info
= qed_dcbnl_get_dcbx(hwfn
, QED_DCBX_REMOTE_MIB
);
1928 info
->willing
= dcbx_info
->remote
.params
.app_willing
;
1929 info
->error
= dcbx_info
->remote
.params
.app_error
;
1930 *app_count
= dcbx_info
->remote
.params
.num_app_entries
;
1936 static int qed_dcbnl_peer_getapptable(struct qed_dev
*cdev
,
1937 struct dcb_app
*table
)
1939 struct qed_hwfn
*hwfn
= QED_LEADING_HWFN(cdev
);
1940 struct qed_dcbx_get
*dcbx_info
;
1943 dcbx_info
= qed_dcbnl_get_dcbx(hwfn
, QED_DCBX_REMOTE_MIB
);
1947 for (i
= 0; i
< dcbx_info
->remote
.params
.num_app_entries
; i
++) {
1948 if (dcbx_info
->remote
.params
.app_entry
[i
].ethtype
)
1949 table
[i
].selector
= DCB_APP_IDTYPE_ETHTYPE
;
1951 table
[i
].selector
= DCB_APP_IDTYPE_PORTNUM
;
1952 table
[i
].priority
= dcbx_info
->remote
.params
.app_entry
[i
].prio
;
1954 dcbx_info
->remote
.params
.app_entry
[i
].proto_id
;
1962 static int qed_dcbnl_cee_peer_getpfc(struct qed_dev
*cdev
, struct cee_pfc
*pfc
)
1964 struct qed_hwfn
*hwfn
= QED_LEADING_HWFN(cdev
);
1965 struct qed_dcbx_get
*dcbx_info
;
1968 dcbx_info
= qed_dcbnl_get_dcbx(hwfn
, QED_DCBX_REMOTE_MIB
);
1972 for (i
= 0; i
< QED_MAX_PFC_PRIORITIES
; i
++)
1973 if (dcbx_info
->remote
.params
.pfc
.prio
[i
])
1974 pfc
->pfc_en
|= BIT(i
);
1976 pfc
->tcs_supported
= dcbx_info
->remote
.params
.pfc
.max_tc
;
1977 DP_VERBOSE(hwfn
, QED_MSG_DCB
, "pfc state = %d tcs_supported = %d\n",
1978 pfc
->pfc_en
, pfc
->tcs_supported
);
1984 static int qed_dcbnl_cee_peer_getpg(struct qed_dev
*cdev
, struct cee_pg
*pg
)
1986 struct qed_hwfn
*hwfn
= QED_LEADING_HWFN(cdev
);
1987 struct qed_dcbx_get
*dcbx_info
;
1990 dcbx_info
= qed_dcbnl_get_dcbx(hwfn
, QED_DCBX_REMOTE_MIB
);
1994 pg
->willing
= dcbx_info
->remote
.params
.ets_willing
;
1995 for (i
= 0; i
< QED_MAX_PFC_PRIORITIES
; i
++) {
1996 pg
->pg_bw
[i
] = dcbx_info
->remote
.params
.ets_tc_bw_tbl
[i
];
1997 pg
->prio_pg
[i
] = dcbx_info
->remote
.params
.ets_pri_tc_tbl
[i
];
2000 DP_VERBOSE(hwfn
, QED_MSG_DCB
, "willing = %d", pg
->willing
);
2006 static int qed_dcbnl_get_ieee_pfc(struct qed_dev
*cdev
,
2007 struct ieee_pfc
*pfc
, bool remote
)
2009 struct qed_hwfn
*hwfn
= QED_LEADING_HWFN(cdev
);
2010 struct qed_dcbx_params
*params
;
2011 struct qed_dcbx_get
*dcbx_info
;
2014 dcbx_info
= qed_dcbnl_get_dcbx(hwfn
, QED_DCBX_OPERATIONAL_MIB
);
2018 if (!dcbx_info
->operational
.ieee
) {
2019 DP_INFO(hwfn
, "DCBX is not enabled/operational in IEEE mode\n");
2025 memset(dcbx_info
, 0, sizeof(*dcbx_info
));
2026 rc
= qed_dcbx_query_params(hwfn
, dcbx_info
,
2027 QED_DCBX_REMOTE_MIB
);
2033 params
= &dcbx_info
->remote
.params
;
2035 params
= &dcbx_info
->operational
.params
;
2038 pfc
->pfc_cap
= params
->pfc
.max_tc
;
2040 for (i
= 0; i
< QED_MAX_PFC_PRIORITIES
; i
++)
2041 if (params
->pfc
.prio
[i
])
2042 pfc
->pfc_en
|= BIT(i
);
2049 static int qed_dcbnl_ieee_getpfc(struct qed_dev
*cdev
, struct ieee_pfc
*pfc
)
2051 return qed_dcbnl_get_ieee_pfc(cdev
, pfc
, false);
2054 static int qed_dcbnl_ieee_setpfc(struct qed_dev
*cdev
, struct ieee_pfc
*pfc
)
2056 struct qed_hwfn
*hwfn
= QED_LEADING_HWFN(cdev
);
2057 struct qed_dcbx_get
*dcbx_info
;
2058 struct qed_dcbx_set dcbx_set
;
2059 struct qed_ptt
*ptt
;
2062 dcbx_info
= qed_dcbnl_get_dcbx(hwfn
, QED_DCBX_OPERATIONAL_MIB
);
2066 if (!dcbx_info
->operational
.ieee
) {
2067 DP_INFO(hwfn
, "DCBX is not enabled/operational in IEEE mode\n");
2074 memset(&dcbx_set
, 0, sizeof(dcbx_set
));
2075 rc
= qed_dcbx_get_config_params(hwfn
, &dcbx_set
);
2079 dcbx_set
.override_flags
|= QED_DCBX_OVERRIDE_PFC_CFG
;
2080 for (i
= 0; i
< QED_MAX_PFC_PRIORITIES
; i
++)
2081 dcbx_set
.config
.params
.pfc
.prio
[i
] = !!(pfc
->pfc_en
& BIT(i
));
2083 dcbx_set
.config
.params
.pfc
.max_tc
= pfc
->pfc_cap
;
2085 ptt
= qed_ptt_acquire(hwfn
);
2089 rc
= qed_dcbx_config_params(hwfn
, ptt
, &dcbx_set
, 0);
2091 qed_ptt_release(hwfn
, ptt
);
2096 static int qed_dcbnl_get_ieee_ets(struct qed_dev
*cdev
,
2097 struct ieee_ets
*ets
, bool remote
)
2099 struct qed_hwfn
*hwfn
= QED_LEADING_HWFN(cdev
);
2100 struct qed_dcbx_get
*dcbx_info
;
2101 struct qed_dcbx_params
*params
;
2104 dcbx_info
= qed_dcbnl_get_dcbx(hwfn
, QED_DCBX_OPERATIONAL_MIB
);
2108 if (!dcbx_info
->operational
.ieee
) {
2109 DP_INFO(hwfn
, "DCBX is not enabled/operational in IEEE mode\n");
2115 memset(dcbx_info
, 0, sizeof(*dcbx_info
));
2116 rc
= qed_dcbx_query_params(hwfn
, dcbx_info
,
2117 QED_DCBX_REMOTE_MIB
);
2123 params
= &dcbx_info
->remote
.params
;
2125 params
= &dcbx_info
->operational
.params
;
2128 ets
->ets_cap
= params
->max_ets_tc
;
2129 ets
->willing
= params
->ets_willing
;
2130 ets
->cbs
= params
->ets_cbs
;
2131 memcpy(ets
->tc_tx_bw
, params
->ets_tc_bw_tbl
, sizeof(ets
->tc_tx_bw
));
2132 memcpy(ets
->tc_tsa
, params
->ets_tc_tsa_tbl
, sizeof(ets
->tc_tsa
));
2133 memcpy(ets
->prio_tc
, params
->ets_pri_tc_tbl
, sizeof(ets
->prio_tc
));
2139 static int qed_dcbnl_ieee_getets(struct qed_dev
*cdev
, struct ieee_ets
*ets
)
2141 return qed_dcbnl_get_ieee_ets(cdev
, ets
, false);
2144 static int qed_dcbnl_ieee_setets(struct qed_dev
*cdev
, struct ieee_ets
*ets
)
2146 struct qed_hwfn
*hwfn
= QED_LEADING_HWFN(cdev
);
2147 struct qed_dcbx_get
*dcbx_info
;
2148 struct qed_dcbx_set dcbx_set
;
2149 struct qed_ptt
*ptt
;
2152 dcbx_info
= qed_dcbnl_get_dcbx(hwfn
, QED_DCBX_OPERATIONAL_MIB
);
2156 if (!dcbx_info
->operational
.ieee
) {
2157 DP_INFO(hwfn
, "DCBX is not enabled/operational in IEEE mode\n");
2164 memset(&dcbx_set
, 0, sizeof(dcbx_set
));
2165 rc
= qed_dcbx_get_config_params(hwfn
, &dcbx_set
);
2169 dcbx_set
.override_flags
|= QED_DCBX_OVERRIDE_ETS_CFG
;
2170 dcbx_set
.config
.params
.max_ets_tc
= ets
->ets_cap
;
2171 dcbx_set
.config
.params
.ets_willing
= ets
->willing
;
2172 dcbx_set
.config
.params
.ets_cbs
= ets
->cbs
;
2173 memcpy(dcbx_set
.config
.params
.ets_tc_bw_tbl
, ets
->tc_tx_bw
,
2174 sizeof(ets
->tc_tx_bw
));
2175 memcpy(dcbx_set
.config
.params
.ets_tc_tsa_tbl
, ets
->tc_tsa
,
2176 sizeof(ets
->tc_tsa
));
2177 memcpy(dcbx_set
.config
.params
.ets_pri_tc_tbl
, ets
->prio_tc
,
2178 sizeof(ets
->prio_tc
));
2180 ptt
= qed_ptt_acquire(hwfn
);
2184 rc
= qed_dcbx_config_params(hwfn
, ptt
, &dcbx_set
, 0);
2186 qed_ptt_release(hwfn
, ptt
);
2192 qed_dcbnl_ieee_peer_getets(struct qed_dev
*cdev
, struct ieee_ets
*ets
)
2194 return qed_dcbnl_get_ieee_ets(cdev
, ets
, true);
2198 qed_dcbnl_ieee_peer_getpfc(struct qed_dev
*cdev
, struct ieee_pfc
*pfc
)
2200 return qed_dcbnl_get_ieee_pfc(cdev
, pfc
, true);
2203 static int qed_dcbnl_ieee_getapp(struct qed_dev
*cdev
, struct dcb_app
*app
)
2205 struct qed_hwfn
*hwfn
= QED_LEADING_HWFN(cdev
);
2206 struct qed_dcbx_get
*dcbx_info
;
2207 struct qed_app_entry
*entry
;
2212 dcbx_info
= qed_dcbnl_get_dcbx(hwfn
, QED_DCBX_OPERATIONAL_MIB
);
2216 if (!dcbx_info
->operational
.ieee
) {
2217 DP_INFO(hwfn
, "DCBX is not enabled/operational in IEEE mode\n");
2222 /* ieee defines the selector field value for ethertype to be 1 */
2223 ethtype
= !!((app
->selector
- 1) == DCB_APP_IDTYPE_ETHTYPE
);
2224 for (i
= 0; i
< QED_DCBX_MAX_APP_PROTOCOL
; i
++) {
2225 entry
= &dcbx_info
->operational
.params
.app_entry
[i
];
2226 if ((entry
->ethtype
== ethtype
) &&
2227 (entry
->proto_id
== app
->protocol
)) {
2233 if (i
== QED_DCBX_MAX_APP_PROTOCOL
) {
2234 DP_ERR(cdev
, "App entry (%d, %d) not found\n", app
->selector
,
2240 app
->priority
= ffs(prio
) - 1;
2247 static int qed_dcbnl_ieee_setapp(struct qed_dev
*cdev
, struct dcb_app
*app
)
2249 struct qed_hwfn
*hwfn
= QED_LEADING_HWFN(cdev
);
2250 struct qed_dcbx_get
*dcbx_info
;
2251 struct qed_dcbx_set dcbx_set
;
2252 struct qed_app_entry
*entry
;
2253 struct qed_ptt
*ptt
;
2257 if (app
->priority
< 0 || app
->priority
>= QED_MAX_PFC_PRIORITIES
) {
2258 DP_INFO(hwfn
, "Invalid priority %d\n", app
->priority
);
2262 dcbx_info
= qed_dcbnl_get_dcbx(hwfn
, QED_DCBX_OPERATIONAL_MIB
);
2266 if (!dcbx_info
->operational
.ieee
) {
2267 DP_INFO(hwfn
, "DCBX is not enabled/operational in IEEE mode\n");
2274 memset(&dcbx_set
, 0, sizeof(dcbx_set
));
2275 rc
= qed_dcbx_get_config_params(hwfn
, &dcbx_set
);
2279 /* ieee defines the selector field value for ethertype to be 1 */
2280 ethtype
= !!((app
->selector
- 1) == DCB_APP_IDTYPE_ETHTYPE
);
2281 for (i
= 0; i
< QED_DCBX_MAX_APP_PROTOCOL
; i
++) {
2282 entry
= &dcbx_set
.config
.params
.app_entry
[i
];
2283 if ((entry
->ethtype
== ethtype
) &&
2284 (entry
->proto_id
== app
->protocol
))
2286 /* First empty slot */
2287 if (!entry
->proto_id
) {
2288 dcbx_set
.config
.params
.num_app_entries
++;
2293 if (i
== QED_DCBX_MAX_APP_PROTOCOL
) {
2294 DP_ERR(cdev
, "App table is full\n");
2298 dcbx_set
.override_flags
|= QED_DCBX_OVERRIDE_APP_CFG
;
2299 dcbx_set
.config
.params
.app_entry
[i
].ethtype
= ethtype
;
2300 dcbx_set
.config
.params
.app_entry
[i
].proto_id
= app
->protocol
;
2301 dcbx_set
.config
.params
.app_entry
[i
].prio
= BIT(app
->priority
);
2303 ptt
= qed_ptt_acquire(hwfn
);
2307 rc
= qed_dcbx_config_params(hwfn
, ptt
, &dcbx_set
, 0);
2309 qed_ptt_release(hwfn
, ptt
);
2314 const struct qed_eth_dcbnl_ops qed_dcbnl_ops_pass
= {
2315 .getstate
= qed_dcbnl_getstate
,
2316 .setstate
= qed_dcbnl_setstate
,
2317 .getpgtccfgtx
= qed_dcbnl_getpgtccfgtx
,
2318 .getpgbwgcfgtx
= qed_dcbnl_getpgbwgcfgtx
,
2319 .getpgtccfgrx
= qed_dcbnl_getpgtccfgrx
,
2320 .getpgbwgcfgrx
= qed_dcbnl_getpgbwgcfgrx
,
2321 .getpfccfg
= qed_dcbnl_getpfccfg
,
2322 .setpfccfg
= qed_dcbnl_setpfccfg
,
2323 .getcap
= qed_dcbnl_getcap
,
2324 .getnumtcs
= qed_dcbnl_getnumtcs
,
2325 .getpfcstate
= qed_dcbnl_getpfcstate
,
2326 .getdcbx
= qed_dcbnl_getdcbx
,
2327 .setpgtccfgtx
= qed_dcbnl_setpgtccfgtx
,
2328 .setpgtccfgrx
= qed_dcbnl_setpgtccfgrx
,
2329 .setpgbwgcfgtx
= qed_dcbnl_setpgbwgcfgtx
,
2330 .setpgbwgcfgrx
= qed_dcbnl_setpgbwgcfgrx
,
2331 .setall
= qed_dcbnl_setall
,
2332 .setnumtcs
= qed_dcbnl_setnumtcs
,
2333 .setpfcstate
= qed_dcbnl_setpfcstate
,
2334 .setapp
= qed_dcbnl_setapp
,
2335 .setdcbx
= qed_dcbnl_setdcbx
,
2336 .setfeatcfg
= qed_dcbnl_setfeatcfg
,
2337 .getfeatcfg
= qed_dcbnl_getfeatcfg
,
2338 .getapp
= qed_dcbnl_getapp
,
2339 .peer_getappinfo
= qed_dcbnl_peer_getappinfo
,
2340 .peer_getapptable
= qed_dcbnl_peer_getapptable
,
2341 .cee_peer_getpfc
= qed_dcbnl_cee_peer_getpfc
,
2342 .cee_peer_getpg
= qed_dcbnl_cee_peer_getpg
,
2343 .ieee_getpfc
= qed_dcbnl_ieee_getpfc
,
2344 .ieee_setpfc
= qed_dcbnl_ieee_setpfc
,
2345 .ieee_getets
= qed_dcbnl_ieee_getets
,
2346 .ieee_setets
= qed_dcbnl_ieee_setets
,
2347 .ieee_peer_getpfc
= qed_dcbnl_ieee_peer_getpfc
,
2348 .ieee_peer_getets
= qed_dcbnl_ieee_peer_getets
,
2349 .ieee_getapp
= qed_dcbnl_ieee_getapp
,
2350 .ieee_setapp
= qed_dcbnl_ieee_setapp
,