1 /* bnx2x_dcb.c: Broadcom Everest network driver.
3 * Copyright 2009-2011 Broadcom Corporation
5 * Unless you and Broadcom execute a separate written software license
6 * agreement governing use of this software, this software is licensed to you
7 * under the terms of the GNU General Public License version 2, available
8 * at http://www.gnu.org/licenses/old-licenses/gpl-2.0.html (the "GPL").
10 * Notwithstanding the above, under no circumstances may you combine this
11 * software in any way with any other Broadcom software provided under a
12 * license other than the GPL, without Broadcom's express prior written
15 * Maintained by: Eilon Greenstein <eilong@broadcom.com>
16 * Written by: Dmitry Kravkov
19 #include <linux/netdevice.h>
20 #include <linux/types.h>
21 #include <linux/errno.h>
23 #include <linux/dcbnl.h>
27 #include "bnx2x_cmn.h"
28 #include "bnx2x_dcb.h"
31 /* forward declarations of dcbx related functions */
32 static void bnx2x_dcbx_stop_hw_tx(struct bnx2x
*bp
);
33 static void bnx2x_pfc_set_pfc(struct bnx2x
*bp
);
34 static void bnx2x_dcbx_update_ets_params(struct bnx2x
*bp
);
35 static void bnx2x_dcbx_resume_hw_tx(struct bnx2x
*bp
);
36 static void bnx2x_dcbx_get_ets_pri_pg_tbl(struct bnx2x
*bp
,
37 u32
*set_configuration_ets_pg
,
39 static void bnx2x_dcbx_get_num_pg_traf_type(struct bnx2x
*bp
,
40 u32
*pg_pri_orginal_spread
,
41 struct pg_help_data
*help_data
);
42 static void bnx2x_dcbx_fill_cos_params(struct bnx2x
*bp
,
43 struct pg_help_data
*help_data
,
44 struct dcbx_ets_feature
*ets
,
45 u32
*pg_pri_orginal_spread
);
46 static void bnx2x_dcbx_separate_pauseable_from_non(struct bnx2x
*bp
,
47 struct cos_help_data
*cos_data
,
48 u32
*pg_pri_orginal_spread
,
49 struct dcbx_ets_feature
*ets
);
50 static void bnx2x_pfc_fw_struct_e2(struct bnx2x
*bp
);
53 static void bnx2x_pfc_set(struct bnx2x
*bp
)
55 struct bnx2x_nig_brb_pfc_port_params pfc_params
= {0};
59 /* Tx COS configuration */
60 if (bp
->dcbx_port_params
.ets
.cos_params
[0].pauseable
)
61 pfc_params
.rx_cos0_priority_mask
=
62 bp
->dcbx_port_params
.ets
.cos_params
[0].pri_bitmask
;
63 if (bp
->dcbx_port_params
.ets
.cos_params
[1].pauseable
)
64 pfc_params
.rx_cos1_priority_mask
=
65 bp
->dcbx_port_params
.ets
.cos_params
[1].pri_bitmask
;
69 * Rx COS configuration
70 * Changing PFC RX configuration .
71 * In RX COS0 will always be configured to lossy and COS1 to lossless
73 for (pri
= 0 ; pri
< MAX_PFC_PRIORITIES
; pri
++) {
76 if (pri_bit
& DCBX_PFC_PRI_PAUSE_MASK(bp
))
77 val
|= 1 << (pri
* 4);
80 pfc_params
.pkt_priority_to_cos
= val
;
83 pfc_params
.llfc_low_priority_classes
= 0;
85 pfc_params
.llfc_high_priority_classes
= DCBX_PFC_PRI_PAUSE_MASK(bp
);
87 /* BRB configuration */
88 pfc_params
.cos0_pauseable
= false;
89 pfc_params
.cos1_pauseable
= true;
91 bnx2x_acquire_phy_lock(bp
);
92 bp
->link_params
.feature_config_flags
|= FEATURE_CONFIG_PFC_ENABLED
;
93 bnx2x_update_pfc(&bp
->link_params
, &bp
->link_vars
, &pfc_params
);
94 bnx2x_release_phy_lock(bp
);
97 static void bnx2x_pfc_clear(struct bnx2x
*bp
)
99 struct bnx2x_nig_brb_pfc_port_params nig_params
= {0};
100 nig_params
.pause_enable
= 1;
102 if (bp
->flags
& SAFC_TX_FLAG
) {
103 u32 high
= 0, low
= 0;
106 for (i
= 0; i
< BNX2X_MAX_PRIORITY
; i
++) {
107 if (bp
->pri_map
[i
] == 1)
109 if (bp
->pri_map
[i
] == 0)
113 nig_params
.llfc_low_priority_classes
= high
;
114 nig_params
.llfc_low_priority_classes
= low
;
116 nig_params
.pause_enable
= 0;
117 nig_params
.llfc_enable
= 1;
118 nig_params
.llfc_out_en
= 1;
120 #endif /* BNX2X_SAFC */
121 bnx2x_acquire_phy_lock(bp
);
122 bp
->link_params
.feature_config_flags
&= ~FEATURE_CONFIG_PFC_ENABLED
;
123 bnx2x_update_pfc(&bp
->link_params
, &bp
->link_vars
, &nig_params
);
124 bnx2x_release_phy_lock(bp
);
127 static void bnx2x_dump_dcbx_drv_param(struct bnx2x
*bp
,
128 struct dcbx_features
*features
,
132 DP(NETIF_MSG_LINK
, "local_mib.error %x\n", error
);
136 "local_mib.features.ets.enabled %x\n", features
->ets
.enabled
);
137 for (i
= 0; i
< DCBX_MAX_NUM_PG_BW_ENTRIES
; i
++)
139 "local_mib.features.ets.pg_bw_tbl[%d] %d\n", i
,
140 DCBX_PG_BW_GET(features
->ets
.pg_bw_tbl
, i
));
141 for (i
= 0; i
< DCBX_MAX_NUM_PRI_PG_ENTRIES
; i
++)
143 "local_mib.features.ets.pri_pg_tbl[%d] %d\n", i
,
144 DCBX_PRI_PG_GET(features
->ets
.pri_pg_tbl
, i
));
147 DP(NETIF_MSG_LINK
, "dcbx_features.pfc.pri_en_bitmap %x\n",
148 features
->pfc
.pri_en_bitmap
);
149 DP(NETIF_MSG_LINK
, "dcbx_features.pfc.pfc_caps %x\n",
150 features
->pfc
.pfc_caps
);
151 DP(NETIF_MSG_LINK
, "dcbx_features.pfc.enabled %x\n",
152 features
->pfc
.enabled
);
154 DP(NETIF_MSG_LINK
, "dcbx_features.app.default_pri %x\n",
155 features
->app
.default_pri
);
156 DP(NETIF_MSG_LINK
, "dcbx_features.app.tc_supported %x\n",
157 features
->app
.tc_supported
);
158 DP(NETIF_MSG_LINK
, "dcbx_features.app.enabled %x\n",
159 features
->app
.enabled
);
160 for (i
= 0; i
< DCBX_MAX_APP_PROTOCOL
; i
++) {
162 "dcbx_features.app.app_pri_tbl[%x].app_id %x\n",
163 i
, features
->app
.app_pri_tbl
[i
].app_id
);
165 "dcbx_features.app.app_pri_tbl[%x].pri_bitmap %x\n",
166 i
, features
->app
.app_pri_tbl
[i
].pri_bitmap
);
168 "dcbx_features.app.app_pri_tbl[%x].appBitfield %x\n",
169 i
, features
->app
.app_pri_tbl
[i
].appBitfield
);
173 static void bnx2x_dcbx_get_ap_priority(struct bnx2x
*bp
,
177 u32 pri
= MAX_PFC_PRIORITIES
;
178 u32 index
= MAX_PFC_PRIORITIES
- 1;
180 u32
*ttp
= bp
->dcbx_port_params
.app
.traffic_type_priority
;
182 /* Choose the highest priority */
183 while ((MAX_PFC_PRIORITIES
== pri
) && (0 != index
)) {
184 pri_mask
= 1 << index
;
185 if (GET_FLAGS(pri_bitmap
, pri_mask
))
190 if (pri
< MAX_PFC_PRIORITIES
)
191 ttp
[llfc_traf_type
] = max_t(u32
, ttp
[llfc_traf_type
], pri
);
194 static void bnx2x_dcbx_get_ap_feature(struct bnx2x
*bp
,
195 struct dcbx_app_priority_feature
*app
,
198 u32
*ttp
= bp
->dcbx_port_params
.app
.traffic_type_priority
;
200 if (GET_FLAGS(error
, DCBX_LOCAL_APP_ERROR
))
201 DP(NETIF_MSG_LINK
, "DCBX_LOCAL_APP_ERROR\n");
203 if (app
->enabled
&& !GET_FLAGS(error
, DCBX_LOCAL_APP_ERROR
)) {
205 bp
->dcbx_port_params
.app
.enabled
= true;
207 for (index
= 0 ; index
< LLFC_DRIVER_TRAFFIC_TYPE_MAX
; index
++)
210 if (app
->default_pri
< MAX_PFC_PRIORITIES
)
211 ttp
[LLFC_TRAFFIC_TYPE_NW
] = app
->default_pri
;
213 for (index
= 0 ; index
< DCBX_MAX_APP_PROTOCOL
; index
++) {
214 struct dcbx_app_priority_entry
*entry
=
217 if (GET_FLAGS(entry
[index
].appBitfield
,
218 DCBX_APP_SF_ETH_TYPE
) &&
219 ETH_TYPE_FCOE
== entry
[index
].app_id
)
220 bnx2x_dcbx_get_ap_priority(bp
,
221 entry
[index
].pri_bitmap
,
222 LLFC_TRAFFIC_TYPE_FCOE
);
224 if (GET_FLAGS(entry
[index
].appBitfield
,
226 TCP_PORT_ISCSI
== entry
[index
].app_id
)
227 bnx2x_dcbx_get_ap_priority(bp
,
228 entry
[index
].pri_bitmap
,
229 LLFC_TRAFFIC_TYPE_ISCSI
);
232 DP(NETIF_MSG_LINK
, "DCBX_LOCAL_APP_DISABLED\n");
233 bp
->dcbx_port_params
.app
.enabled
= false;
234 for (index
= 0 ; index
< LLFC_DRIVER_TRAFFIC_TYPE_MAX
; index
++)
235 ttp
[index
] = INVALID_TRAFFIC_TYPE_PRIORITY
;
239 static void bnx2x_dcbx_get_ets_feature(struct bnx2x
*bp
,
240 struct dcbx_ets_feature
*ets
,
243 u32 pg_pri_orginal_spread
[DCBX_MAX_NUM_PG_BW_ENTRIES
] = {0};
244 struct pg_help_data pg_help_data
;
245 struct bnx2x_dcbx_cos_params
*cos_params
=
246 bp
->dcbx_port_params
.ets
.cos_params
;
248 memset(&pg_help_data
, 0, sizeof(struct pg_help_data
));
251 if (GET_FLAGS(error
, DCBX_LOCAL_ETS_ERROR
))
252 DP(NETIF_MSG_LINK
, "DCBX_LOCAL_ETS_ERROR\n");
255 /* Clean up old settings of ets on COS */
256 for (i
= 0; i
< E2_NUM_OF_COS
; i
++) {
258 cos_params
[i
].pauseable
= false;
259 cos_params
[i
].strict
= BNX2X_DCBX_COS_NOT_STRICT
;
260 cos_params
[i
].bw_tbl
= DCBX_INVALID_COS_BW
;
261 cos_params
[i
].pri_bitmask
= DCBX_PFC_PRI_GET_NON_PAUSE(bp
, 0);
264 if (bp
->dcbx_port_params
.app
.enabled
&&
265 !GET_FLAGS(error
, DCBX_LOCAL_ETS_ERROR
) &&
267 DP(NETIF_MSG_LINK
, "DCBX_LOCAL_ETS_ENABLE\n");
268 bp
->dcbx_port_params
.ets
.enabled
= true;
270 bnx2x_dcbx_get_ets_pri_pg_tbl(bp
,
271 pg_pri_orginal_spread
,
274 bnx2x_dcbx_get_num_pg_traf_type(bp
,
275 pg_pri_orginal_spread
,
278 bnx2x_dcbx_fill_cos_params(bp
, &pg_help_data
,
279 ets
, pg_pri_orginal_spread
);
282 DP(NETIF_MSG_LINK
, "DCBX_LOCAL_ETS_DISABLED\n");
283 bp
->dcbx_port_params
.ets
.enabled
= false;
284 ets
->pri_pg_tbl
[0] = 0;
286 for (i
= 0; i
< DCBX_MAX_NUM_PRI_PG_ENTRIES
; i
++)
287 DCBX_PG_BW_SET(ets
->pg_bw_tbl
, i
, 1);
291 static void bnx2x_dcbx_get_pfc_feature(struct bnx2x
*bp
,
292 struct dcbx_pfc_feature
*pfc
, u32 error
)
295 if (GET_FLAGS(error
, DCBX_LOCAL_PFC_ERROR
))
296 DP(NETIF_MSG_LINK
, "DCBX_LOCAL_PFC_ERROR\n");
298 if (bp
->dcbx_port_params
.app
.enabled
&&
299 !GET_FLAGS(error
, DCBX_LOCAL_PFC_ERROR
) &&
301 bp
->dcbx_port_params
.pfc
.enabled
= true;
302 bp
->dcbx_port_params
.pfc
.priority_non_pauseable_mask
=
303 ~(pfc
->pri_en_bitmap
);
305 DP(NETIF_MSG_LINK
, "DCBX_LOCAL_PFC_DISABLED\n");
306 bp
->dcbx_port_params
.pfc
.enabled
= false;
307 bp
->dcbx_port_params
.pfc
.priority_non_pauseable_mask
= 0;
311 static void bnx2x_get_dcbx_drv_param(struct bnx2x
*bp
,
312 struct dcbx_features
*features
,
315 bnx2x_dcbx_get_ap_feature(bp
, &features
->app
, error
);
317 bnx2x_dcbx_get_pfc_feature(bp
, &features
->pfc
, error
);
319 bnx2x_dcbx_get_ets_feature(bp
, &features
->ets
, error
);
322 #define DCBX_LOCAL_MIB_MAX_TRY_READ (100)
323 static int bnx2x_dcbx_read_mib(struct bnx2x
*bp
,
328 int max_try_read
= 0, i
;
329 u32
*buff
, mib_size
, prefix_seq_num
, suffix_seq_num
;
330 struct lldp_remote_mib
*remote_mib
;
331 struct lldp_local_mib
*local_mib
;
334 switch (read_mib_type
) {
335 case DCBX_READ_LOCAL_MIB
:
336 mib_size
= sizeof(struct lldp_local_mib
);
338 case DCBX_READ_REMOTE_MIB
:
339 mib_size
= sizeof(struct lldp_remote_mib
);
345 offset
+= BP_PORT(bp
) * mib_size
;
348 buff
= base_mib_addr
;
349 for (i
= 0; i
< mib_size
; i
+= 4, buff
++)
350 *buff
= REG_RD(bp
, offset
+ i
);
354 switch (read_mib_type
) {
355 case DCBX_READ_LOCAL_MIB
:
356 local_mib
= (struct lldp_local_mib
*) base_mib_addr
;
357 prefix_seq_num
= local_mib
->prefix_seq_num
;
358 suffix_seq_num
= local_mib
->suffix_seq_num
;
360 case DCBX_READ_REMOTE_MIB
:
361 remote_mib
= (struct lldp_remote_mib
*) base_mib_addr
;
362 prefix_seq_num
= remote_mib
->prefix_seq_num
;
363 suffix_seq_num
= remote_mib
->suffix_seq_num
;
368 } while ((prefix_seq_num
!= suffix_seq_num
) &&
369 (max_try_read
< DCBX_LOCAL_MIB_MAX_TRY_READ
));
371 if (max_try_read
>= DCBX_LOCAL_MIB_MAX_TRY_READ
) {
372 BNX2X_ERR("MIB could not be read\n");
379 static void bnx2x_pfc_set_pfc(struct bnx2x
*bp
)
381 if (CHIP_IS_E2(bp
)) {
383 BNX2X_ERR("4 port mode is not supported");
387 if (bp
->dcbx_port_params
.pfc
.enabled
)
389 /* 1. Fills up common PFC structures if required.*/
390 /* 2. Configure NIG, MAC and BRB via the elink:
391 * elink must first check if BMAC is not in reset
392 * and only then configures the BMAC
393 * Or, configure EMAC.
402 static void bnx2x_dcbx_stop_hw_tx(struct bnx2x
*bp
)
404 DP(NETIF_MSG_LINK
, "sending STOP TRAFFIC\n");
405 bnx2x_sp_post(bp
, RAMROD_CMD_ID_COMMON_STOP_TRAFFIC
,
406 0 /* connectionless */,
407 0 /* dataHi is zero */,
408 0 /* dataLo is zero */,
412 static void bnx2x_dcbx_resume_hw_tx(struct bnx2x
*bp
)
414 bnx2x_pfc_fw_struct_e2(bp
);
415 DP(NETIF_MSG_LINK
, "sending START TRAFFIC\n");
416 bnx2x_sp_post(bp
, RAMROD_CMD_ID_COMMON_START_TRAFFIC
,
417 0, /* connectionless */
418 U64_HI(bnx2x_sp_mapping(bp
, pfc_config
)),
419 U64_LO(bnx2x_sp_mapping(bp
, pfc_config
)),
423 static void bnx2x_dcbx_update_ets_params(struct bnx2x
*bp
)
425 struct bnx2x_dcbx_pg_params
*ets
= &(bp
->dcbx_port_params
.ets
);
428 bnx2x_ets_disabled(&bp
->link_params
);
433 if ((ets
->num_of_cos
== 0) || (ets
->num_of_cos
> E2_NUM_OF_COS
)) {
434 BNX2X_ERR("illegal num of cos= %x", ets
->num_of_cos
);
438 /* valid COS entries */
439 if (ets
->num_of_cos
== 1) /* no ETS */
443 if (((BNX2X_DCBX_COS_NOT_STRICT
== ets
->cos_params
[0].strict
) &&
444 (DCBX_INVALID_COS_BW
== ets
->cos_params
[0].bw_tbl
)) ||
445 ((BNX2X_DCBX_COS_NOT_STRICT
== ets
->cos_params
[1].strict
) &&
446 (DCBX_INVALID_COS_BW
== ets
->cos_params
[1].bw_tbl
))) {
447 BNX2X_ERR("all COS should have at least bw_limit or strict"
448 "ets->cos_params[0].strict= %x"
449 "ets->cos_params[0].bw_tbl= %x"
450 "ets->cos_params[1].strict= %x"
451 "ets->cos_params[1].bw_tbl= %x",
452 ets
->cos_params
[0].strict
,
453 ets
->cos_params
[0].bw_tbl
,
454 ets
->cos_params
[1].strict
,
455 ets
->cos_params
[1].bw_tbl
);
458 /* If we join a group and there is bw_tbl and strict then bw rules */
459 if ((DCBX_INVALID_COS_BW
!= ets
->cos_params
[0].bw_tbl
) &&
460 (DCBX_INVALID_COS_BW
!= ets
->cos_params
[1].bw_tbl
)) {
461 u32 bw_tbl_0
= ets
->cos_params
[0].bw_tbl
;
462 u32 bw_tbl_1
= ets
->cos_params
[1].bw_tbl
;
463 /* Do not allow 0-100 configuration
464 * since PBF does not support it
470 } else if (bw_tbl_1
== 0) {
475 bnx2x_ets_bw_limit(&bp
->link_params
, bw_tbl_0
, bw_tbl_1
);
477 if (ets
->cos_params
[0].strict
== BNX2X_DCBX_COS_HIGH_STRICT
)
478 status
= bnx2x_ets_strict(&bp
->link_params
, 0);
479 else if (ets
->cos_params
[1].strict
480 == BNX2X_DCBX_COS_HIGH_STRICT
)
481 status
= bnx2x_ets_strict(&bp
->link_params
, 1);
484 BNX2X_ERR("update_ets_params failed\n");
488 static int bnx2x_dcbx_read_shmem_neg_results(struct bnx2x
*bp
)
490 struct lldp_local_mib local_mib
= {0};
491 u32 dcbx_neg_res_offset
= SHMEM2_RD(bp
, dcbx_neg_res_offset
);
494 DP(NETIF_MSG_LINK
, "dcbx_neg_res_offset 0x%x\n", dcbx_neg_res_offset
);
496 if (SHMEM_DCBX_NEG_RES_NONE
== dcbx_neg_res_offset
) {
497 BNX2X_ERR("FW doesn't support dcbx_neg_res_offset\n");
500 rc
= bnx2x_dcbx_read_mib(bp
, (u32
*)&local_mib
, dcbx_neg_res_offset
,
501 DCBX_READ_LOCAL_MIB
);
504 BNX2X_ERR("Faild to read local mib from FW\n");
508 /* save features and error */
509 bp
->dcbx_local_feat
= local_mib
.features
;
510 bp
->dcbx_error
= local_mib
.error
;
517 u8
bnx2x_dcbx_dcbnl_app_up(struct dcbx_app_priority_entry
*ent
)
521 /* Choose the highest priority */
522 for (pri
= MAX_PFC_PRIORITIES
- 1; pri
> 0; pri
--)
523 if (ent
->pri_bitmap
& (1 << pri
))
529 u8
bnx2x_dcbx_dcbnl_app_idtype(struct dcbx_app_priority_entry
*ent
)
531 return ((ent
->appBitfield
& DCBX_APP_ENTRY_SF_MASK
) ==
532 DCBX_APP_SF_PORT
) ? DCB_APP_IDTYPE_PORTNUM
:
533 DCB_APP_IDTYPE_ETHTYPE
;
537 void bnx2x_dcbx_invalidate_local_apps(struct bnx2x
*bp
)
540 for (i
= 0; i
< DCBX_MAX_APP_PROTOCOL
; i
++)
541 bp
->dcbx_local_feat
.app
.app_pri_tbl
[i
].appBitfield
&=
542 ~DCBX_APP_ENTRY_VALID
;
545 int bnx2x_dcbnl_update_applist(struct bnx2x
*bp
, bool delall
)
549 for (i
= 0; i
< DCBX_MAX_APP_PROTOCOL
&& err
== 0; i
++) {
550 struct dcbx_app_priority_entry
*ent
=
551 &bp
->dcbx_local_feat
.app
.app_pri_tbl
[i
];
553 if (ent
->appBitfield
& DCBX_APP_ENTRY_VALID
) {
554 u8 up
= bnx2x_dcbx_dcbnl_app_up(ent
);
556 /* avoid invalid user-priority */
559 app
.selector
= bnx2x_dcbx_dcbnl_app_idtype(ent
);
560 app
.protocol
= ent
->app_id
;
561 app
.priority
= delall
? 0 : up
;
562 err
= dcb_setapp(bp
->dev
, &app
);
570 void bnx2x_dcbx_set_params(struct bnx2x
*bp
, u32 state
)
573 case BNX2X_DCBX_STATE_NEG_RECEIVED
:
575 if (bp
->state
!= BNX2X_STATE_OPENING_WAIT4_LOAD
) {
576 struct cnic_ops
*c_ops
;
577 struct cnic_eth_dev
*cp
= &bp
->cnic_eth_dev
;
578 bp
->flags
|= NO_ISCSI_OOO_FLAG
| NO_ISCSI_FLAG
;
579 cp
->drv_state
|= CNIC_DRV_STATE_NO_ISCSI_OOO
;
580 cp
->drv_state
|= CNIC_DRV_STATE_NO_ISCSI
;
583 c_ops
= rcu_dereference(bp
->cnic_ops
);
585 bnx2x_cnic_notify(bp
, CNIC_CTL_STOP_ISCSI_CMD
);
592 /* fall through if no CNIC initialized */
593 case BNX2X_DCBX_STATE_ISCSI_STOPPED
:
597 DP(NETIF_MSG_LINK
, "BNX2X_DCBX_STATE_NEG_RECEIVED\n");
600 * Delete app tlvs from dcbnl before reading new
601 * negotiation results
603 bnx2x_dcbnl_update_applist(bp
, true);
605 /* Read neg results if dcbx is in the FW */
606 if (bnx2x_dcbx_read_shmem_neg_results(bp
))
609 bnx2x_dump_dcbx_drv_param(bp
, &bp
->dcbx_local_feat
,
612 bnx2x_get_dcbx_drv_param(bp
, &bp
->dcbx_local_feat
,
615 if (bp
->state
!= BNX2X_STATE_OPENING_WAIT4_LOAD
) {
618 * Add new app tlvs to dcbnl
620 bnx2x_dcbnl_update_applist(bp
, false);
622 bnx2x_dcbx_stop_hw_tx(bp
);
628 * Invalidate the local app tlvs if they are not added
629 * to the dcbnl app list to avoid deleting them from
632 bnx2x_dcbx_invalidate_local_apps(bp
);
635 case BNX2X_DCBX_STATE_TX_PAUSED
:
636 DP(NETIF_MSG_LINK
, "BNX2X_DCBX_STATE_TX_PAUSED\n");
637 bnx2x_pfc_set_pfc(bp
);
639 bnx2x_dcbx_update_ets_params(bp
);
640 if (bp
->state
!= BNX2X_STATE_OPENING_WAIT4_LOAD
) {
641 bnx2x_dcbx_resume_hw_tx(bp
);
645 case BNX2X_DCBX_STATE_TX_RELEASED
:
646 DP(NETIF_MSG_LINK
, "BNX2X_DCBX_STATE_TX_RELEASED\n");
647 if (bp
->state
!= BNX2X_STATE_OPENING_WAIT4_LOAD
)
648 bnx2x_fw_command(bp
, DRV_MSG_CODE_DCBX_PMF_DRV_OK
, 0);
652 BNX2X_ERR("Unknown DCBX_STATE\n");
657 #define LLDP_STATS_OFFSET(bp) (BP_PORT(bp)*\
658 sizeof(struct lldp_dcbx_stat))
660 /* calculate struct offset in array according to chip information */
661 #define LLDP_PARAMS_OFFSET(bp) (BP_PORT(bp)*sizeof(struct lldp_params))
663 #define LLDP_ADMIN_MIB_OFFSET(bp) (PORT_MAX*sizeof(struct lldp_params) + \
664 BP_PORT(bp)*sizeof(struct lldp_admin_mib))
666 static void bnx2x_dcbx_lldp_updated_params(struct bnx2x
*bp
,
667 u32 dcbx_lldp_params_offset
)
669 struct lldp_params lldp_params
= {0};
670 u32 i
= 0, *buff
= NULL
;
671 u32 offset
= dcbx_lldp_params_offset
+ LLDP_PARAMS_OFFSET(bp
);
673 DP(NETIF_MSG_LINK
, "lldp_offset 0x%x\n", offset
);
675 if ((bp
->lldp_config_params
.overwrite_settings
==
676 BNX2X_DCBX_OVERWRITE_SETTINGS_ENABLE
)) {
677 /* Read the data first */
678 buff
= (u32
*)&lldp_params
;
679 for (i
= 0; i
< sizeof(struct lldp_params
); i
+= 4, buff
++)
680 *buff
= REG_RD(bp
, (offset
+ i
));
682 lldp_params
.msg_tx_hold
=
683 (u8
)bp
->lldp_config_params
.msg_tx_hold
;
684 lldp_params
.msg_fast_tx_interval
=
685 (u8
)bp
->lldp_config_params
.msg_fast_tx
;
686 lldp_params
.tx_crd_max
=
687 (u8
)bp
->lldp_config_params
.tx_credit_max
;
688 lldp_params
.msg_tx_interval
=
689 (u8
)bp
->lldp_config_params
.msg_tx_interval
;
690 lldp_params
.tx_fast
=
691 (u8
)bp
->lldp_config_params
.tx_fast
;
694 buff
= (u32
*)&lldp_params
;
695 for (i
= 0; i
< sizeof(struct lldp_params
); i
+= 4, buff
++)
696 REG_WR(bp
, (offset
+ i
) , *buff
);
699 } else if (BNX2X_DCBX_OVERWRITE_SETTINGS_ENABLE
==
700 bp
->lldp_config_params
.overwrite_settings
)
701 bp
->lldp_config_params
.overwrite_settings
=
702 BNX2X_DCBX_OVERWRITE_SETTINGS_INVALID
;
705 static void bnx2x_dcbx_admin_mib_updated_params(struct bnx2x
*bp
,
706 u32 dcbx_lldp_params_offset
)
708 struct lldp_admin_mib admin_mib
;
709 u32 i
, other_traf_type
= PREDEFINED_APP_IDX_MAX
, traf_type
= 0;
711 u32 offset
= dcbx_lldp_params_offset
+ LLDP_ADMIN_MIB_OFFSET(bp
);
714 struct dcbx_features
*af
= &admin_mib
.features
;
715 struct bnx2x_config_dcbx_params
*dp
= &bp
->dcbx_config_params
;
717 memset(&admin_mib
, 0, sizeof(struct lldp_admin_mib
));
718 buff
= (u32
*)&admin_mib
;
719 /* Read the data first */
720 for (i
= 0; i
< sizeof(struct lldp_admin_mib
); i
+= 4, buff
++)
721 *buff
= REG_RD(bp
, (offset
+ i
));
723 if (bp
->dcbx_enabled
== BNX2X_DCBX_ENABLED_ON_NEG_ON
)
724 SET_FLAGS(admin_mib
.ver_cfg_flags
, DCBX_DCBX_ENABLED
);
726 RESET_FLAGS(admin_mib
.ver_cfg_flags
, DCBX_DCBX_ENABLED
);
728 if ((BNX2X_DCBX_OVERWRITE_SETTINGS_ENABLE
==
729 dp
->overwrite_settings
)) {
730 RESET_FLAGS(admin_mib
.ver_cfg_flags
, DCBX_CEE_VERSION_MASK
);
731 admin_mib
.ver_cfg_flags
|=
732 (dp
->admin_dcbx_version
<< DCBX_CEE_VERSION_SHIFT
) &
733 DCBX_CEE_VERSION_MASK
;
735 af
->ets
.enabled
= (u8
)dp
->admin_ets_enable
;
737 af
->pfc
.enabled
= (u8
)dp
->admin_pfc_enable
;
739 /* FOR IEEE dp->admin_tc_supported_tx_enable */
740 if (dp
->admin_ets_configuration_tx_enable
)
741 SET_FLAGS(admin_mib
.ver_cfg_flags
,
742 DCBX_ETS_CONFIG_TX_ENABLED
);
744 RESET_FLAGS(admin_mib
.ver_cfg_flags
,
745 DCBX_ETS_CONFIG_TX_ENABLED
);
746 /* For IEEE admin_ets_recommendation_tx_enable */
747 if (dp
->admin_pfc_tx_enable
)
748 SET_FLAGS(admin_mib
.ver_cfg_flags
,
749 DCBX_PFC_CONFIG_TX_ENABLED
);
751 RESET_FLAGS(admin_mib
.ver_cfg_flags
,
752 DCBX_PFC_CONFIG_TX_ENABLED
);
754 if (dp
->admin_application_priority_tx_enable
)
755 SET_FLAGS(admin_mib
.ver_cfg_flags
,
756 DCBX_APP_CONFIG_TX_ENABLED
);
758 RESET_FLAGS(admin_mib
.ver_cfg_flags
,
759 DCBX_APP_CONFIG_TX_ENABLED
);
761 if (dp
->admin_ets_willing
)
762 SET_FLAGS(admin_mib
.ver_cfg_flags
, DCBX_ETS_WILLING
);
764 RESET_FLAGS(admin_mib
.ver_cfg_flags
, DCBX_ETS_WILLING
);
765 /* For IEEE admin_ets_reco_valid */
766 if (dp
->admin_pfc_willing
)
767 SET_FLAGS(admin_mib
.ver_cfg_flags
, DCBX_PFC_WILLING
);
769 RESET_FLAGS(admin_mib
.ver_cfg_flags
, DCBX_PFC_WILLING
);
771 if (dp
->admin_app_priority_willing
)
772 SET_FLAGS(admin_mib
.ver_cfg_flags
, DCBX_APP_WILLING
);
774 RESET_FLAGS(admin_mib
.ver_cfg_flags
, DCBX_APP_WILLING
);
776 for (i
= 0 ; i
< DCBX_MAX_NUM_PG_BW_ENTRIES
; i
++) {
777 DCBX_PG_BW_SET(af
->ets
.pg_bw_tbl
, i
,
778 (u8
)dp
->admin_configuration_bw_precentage
[i
]);
780 DP(NETIF_MSG_LINK
, "pg_bw_tbl[%d] = %02x\n",
781 i
, DCBX_PG_BW_GET(af
->ets
.pg_bw_tbl
, i
));
784 for (i
= 0; i
< DCBX_MAX_NUM_PRI_PG_ENTRIES
; i
++) {
785 DCBX_PRI_PG_SET(af
->ets
.pri_pg_tbl
, i
,
786 (u8
)dp
->admin_configuration_ets_pg
[i
]);
788 DP(NETIF_MSG_LINK
, "pri_pg_tbl[%d] = %02x\n",
789 i
, DCBX_PRI_PG_GET(af
->ets
.pri_pg_tbl
, i
));
792 /*For IEEE admin_recommendation_bw_precentage
793 *For IEEE admin_recommendation_ets_pg */
794 af
->pfc
.pri_en_bitmap
= (u8
)dp
->admin_pfc_bitmap
;
795 for (i
= 0; i
< 4; i
++) {
796 if (dp
->admin_priority_app_table
[i
].valid
) {
797 struct bnx2x_admin_priority_app_table
*table
=
798 dp
->admin_priority_app_table
;
799 if ((ETH_TYPE_FCOE
== table
[i
].app_id
) &&
800 (TRAFFIC_TYPE_ETH
== table
[i
].traffic_type
))
801 traf_type
= FCOE_APP_IDX
;
802 else if ((TCP_PORT_ISCSI
== table
[i
].app_id
) &&
803 (TRAFFIC_TYPE_PORT
== table
[i
].traffic_type
))
804 traf_type
= ISCSI_APP_IDX
;
806 traf_type
= other_traf_type
++;
808 af
->app
.app_pri_tbl
[traf_type
].app_id
=
811 af
->app
.app_pri_tbl
[traf_type
].pri_bitmap
=
812 (u8
)(1 << table
[i
].priority
);
814 af
->app
.app_pri_tbl
[traf_type
].appBitfield
=
815 (DCBX_APP_ENTRY_VALID
);
817 af
->app
.app_pri_tbl
[traf_type
].appBitfield
|=
818 (TRAFFIC_TYPE_ETH
== table
[i
].traffic_type
) ?
819 DCBX_APP_SF_ETH_TYPE
: DCBX_APP_SF_PORT
;
823 af
->app
.default_pri
= (u8
)dp
->admin_default_priority
;
825 } else if (BNX2X_DCBX_OVERWRITE_SETTINGS_ENABLE
==
826 dp
->overwrite_settings
)
827 dp
->overwrite_settings
= BNX2X_DCBX_OVERWRITE_SETTINGS_INVALID
;
829 /* Write the data. */
830 buff
= (u32
*)&admin_mib
;
831 for (i
= 0; i
< sizeof(struct lldp_admin_mib
); i
+= 4, buff
++)
832 REG_WR(bp
, (offset
+ i
), *buff
);
835 void bnx2x_dcbx_set_state(struct bnx2x
*bp
, bool dcb_on
, u32 dcbx_enabled
)
837 if (CHIP_IS_E2(bp
) && !CHIP_MODE_IS_4_PORT(bp
)) {
838 bp
->dcb_state
= dcb_on
;
839 bp
->dcbx_enabled
= dcbx_enabled
;
841 bp
->dcb_state
= false;
842 bp
->dcbx_enabled
= BNX2X_DCBX_ENABLED_INVALID
;
844 DP(NETIF_MSG_LINK
, "DCB state [%s:%s]\n",
845 dcb_on
? "ON" : "OFF",
846 dcbx_enabled
== BNX2X_DCBX_ENABLED_OFF
? "user-mode" :
847 dcbx_enabled
== BNX2X_DCBX_ENABLED_ON_NEG_OFF
? "on-chip static" :
848 dcbx_enabled
== BNX2X_DCBX_ENABLED_ON_NEG_ON
?
849 "on-chip with negotiation" : "invalid");
852 void bnx2x_dcbx_init_params(struct bnx2x
*bp
)
854 bp
->dcbx_config_params
.admin_dcbx_version
= 0x0; /* 0 - CEE; 1 - IEEE */
855 bp
->dcbx_config_params
.admin_ets_willing
= 1;
856 bp
->dcbx_config_params
.admin_pfc_willing
= 1;
857 bp
->dcbx_config_params
.overwrite_settings
= 1;
858 bp
->dcbx_config_params
.admin_ets_enable
= 1;
859 bp
->dcbx_config_params
.admin_pfc_enable
= 1;
860 bp
->dcbx_config_params
.admin_tc_supported_tx_enable
= 1;
861 bp
->dcbx_config_params
.admin_ets_configuration_tx_enable
= 1;
862 bp
->dcbx_config_params
.admin_pfc_tx_enable
= 1;
863 bp
->dcbx_config_params
.admin_application_priority_tx_enable
= 1;
864 bp
->dcbx_config_params
.admin_ets_reco_valid
= 1;
865 bp
->dcbx_config_params
.admin_app_priority_willing
= 1;
866 bp
->dcbx_config_params
.admin_configuration_bw_precentage
[0] = 00;
867 bp
->dcbx_config_params
.admin_configuration_bw_precentage
[1] = 50;
868 bp
->dcbx_config_params
.admin_configuration_bw_precentage
[2] = 50;
869 bp
->dcbx_config_params
.admin_configuration_bw_precentage
[3] = 0;
870 bp
->dcbx_config_params
.admin_configuration_bw_precentage
[4] = 0;
871 bp
->dcbx_config_params
.admin_configuration_bw_precentage
[5] = 0;
872 bp
->dcbx_config_params
.admin_configuration_bw_precentage
[6] = 0;
873 bp
->dcbx_config_params
.admin_configuration_bw_precentage
[7] = 0;
874 bp
->dcbx_config_params
.admin_configuration_ets_pg
[0] = 1;
875 bp
->dcbx_config_params
.admin_configuration_ets_pg
[1] = 0;
876 bp
->dcbx_config_params
.admin_configuration_ets_pg
[2] = 0;
877 bp
->dcbx_config_params
.admin_configuration_ets_pg
[3] = 2;
878 bp
->dcbx_config_params
.admin_configuration_ets_pg
[4] = 0;
879 bp
->dcbx_config_params
.admin_configuration_ets_pg
[5] = 0;
880 bp
->dcbx_config_params
.admin_configuration_ets_pg
[6] = 0;
881 bp
->dcbx_config_params
.admin_configuration_ets_pg
[7] = 0;
882 bp
->dcbx_config_params
.admin_recommendation_bw_precentage
[0] = 0;
883 bp
->dcbx_config_params
.admin_recommendation_bw_precentage
[1] = 1;
884 bp
->dcbx_config_params
.admin_recommendation_bw_precentage
[2] = 2;
885 bp
->dcbx_config_params
.admin_recommendation_bw_precentage
[3] = 0;
886 bp
->dcbx_config_params
.admin_recommendation_bw_precentage
[4] = 7;
887 bp
->dcbx_config_params
.admin_recommendation_bw_precentage
[5] = 5;
888 bp
->dcbx_config_params
.admin_recommendation_bw_precentage
[6] = 6;
889 bp
->dcbx_config_params
.admin_recommendation_bw_precentage
[7] = 7;
890 bp
->dcbx_config_params
.admin_recommendation_ets_pg
[0] = 0;
891 bp
->dcbx_config_params
.admin_recommendation_ets_pg
[1] = 1;
892 bp
->dcbx_config_params
.admin_recommendation_ets_pg
[2] = 2;
893 bp
->dcbx_config_params
.admin_recommendation_ets_pg
[3] = 3;
894 bp
->dcbx_config_params
.admin_recommendation_ets_pg
[4] = 4;
895 bp
->dcbx_config_params
.admin_recommendation_ets_pg
[5] = 5;
896 bp
->dcbx_config_params
.admin_recommendation_ets_pg
[6] = 6;
897 bp
->dcbx_config_params
.admin_recommendation_ets_pg
[7] = 7;
898 bp
->dcbx_config_params
.admin_pfc_bitmap
= 0x8; /* FCoE(3) enable */
899 bp
->dcbx_config_params
.admin_priority_app_table
[0].valid
= 1;
900 bp
->dcbx_config_params
.admin_priority_app_table
[1].valid
= 1;
901 bp
->dcbx_config_params
.admin_priority_app_table
[2].valid
= 0;
902 bp
->dcbx_config_params
.admin_priority_app_table
[3].valid
= 0;
903 bp
->dcbx_config_params
.admin_priority_app_table
[0].priority
= 3;
904 bp
->dcbx_config_params
.admin_priority_app_table
[1].priority
= 0;
905 bp
->dcbx_config_params
.admin_priority_app_table
[2].priority
= 0;
906 bp
->dcbx_config_params
.admin_priority_app_table
[3].priority
= 0;
907 bp
->dcbx_config_params
.admin_priority_app_table
[0].traffic_type
= 0;
908 bp
->dcbx_config_params
.admin_priority_app_table
[1].traffic_type
= 1;
909 bp
->dcbx_config_params
.admin_priority_app_table
[2].traffic_type
= 0;
910 bp
->dcbx_config_params
.admin_priority_app_table
[3].traffic_type
= 0;
911 bp
->dcbx_config_params
.admin_priority_app_table
[0].app_id
= 0x8906;
912 bp
->dcbx_config_params
.admin_priority_app_table
[1].app_id
= 3260;
913 bp
->dcbx_config_params
.admin_priority_app_table
[2].app_id
= 0;
914 bp
->dcbx_config_params
.admin_priority_app_table
[3].app_id
= 0;
915 bp
->dcbx_config_params
.admin_default_priority
=
916 bp
->dcbx_config_params
.admin_priority_app_table
[1].priority
;
919 void bnx2x_dcbx_init(struct bnx2x
*bp
)
921 u32 dcbx_lldp_params_offset
= SHMEM_LLDP_DCBX_PARAMS_NONE
;
923 if (bp
->dcbx_enabled
<= 0)
927 * chip of good for dcbx version,
929 * the function is pmf
930 * shmem2 contains DCBX support fields
932 DP(NETIF_MSG_LINK
, "dcb_state %d bp->port.pmf %d\n",
933 bp
->dcb_state
, bp
->port
.pmf
);
935 if (bp
->dcb_state
== BNX2X_DCB_STATE_ON
&& bp
->port
.pmf
&&
936 SHMEM2_HAS(bp
, dcbx_lldp_params_offset
)) {
937 dcbx_lldp_params_offset
=
938 SHMEM2_RD(bp
, dcbx_lldp_params_offset
);
940 DP(NETIF_MSG_LINK
, "dcbx_lldp_params_offset 0x%x\n",
941 dcbx_lldp_params_offset
);
943 if (SHMEM_LLDP_DCBX_PARAMS_NONE
!= dcbx_lldp_params_offset
) {
944 bnx2x_dcbx_lldp_updated_params(bp
,
945 dcbx_lldp_params_offset
);
947 bnx2x_dcbx_admin_mib_updated_params(bp
,
948 dcbx_lldp_params_offset
);
950 /* set default configuration BC has */
951 bnx2x_dcbx_set_params(bp
,
952 BNX2X_DCBX_STATE_NEG_RECEIVED
);
955 DRV_MSG_CODE_DCBX_ADMIN_PMF_MSG
, 0);
960 void bnx2x_dcb_init_intmem_pfc(struct bnx2x
*bp
)
962 struct priority_cos pricos
[MAX_PFC_TRAFFIC_TYPES
];
964 memset(pricos
, 0, sizeof(pricos
));
965 /* Default initialization */
966 for (i
= 0; i
< MAX_PFC_TRAFFIC_TYPES
; i
++)
967 pricos
[i
].priority
= LLFC_TRAFFIC_TYPE_TO_PRIORITY_UNMAPPED
;
969 /* Store per port struct to internal memory */
970 addr
= BAR_XSTRORM_INTMEM
+
971 XSTORM_CMNG_PER_PORT_VARS_OFFSET(BP_PORT(bp
)) +
972 offsetof(struct cmng_struct_per_port
,
973 traffic_type_to_priority_cos
);
974 __storm_memset_struct(bp
, addr
, sizeof(pricos
), (u32
*)pricos
);
978 REG_WR8(bp
, BAR_XSTRORM_INTMEM
+
979 XSTORM_CMNG_PER_PORT_VARS_OFFSET(BP_PORT(bp
)) +
980 offsetof(struct cmng_struct_per_port
, llfc_mode
),
984 REG_WR8(bp
, BAR_XSTRORM_INTMEM
+
985 XSTORM_CMNG_PER_PORT_VARS_OFFSET(BP_PORT(bp
)) +
986 offsetof(struct cmng_struct_per_port
, dcb_enabled
),
991 bnx2x_dcbx_print_cos_params(struct bnx2x
*bp
,
992 struct flow_control_configuration
*pfc_fw_cfg
)
998 "pfc_fw_cfg->dcb_version %x\n", pfc_fw_cfg
->dcb_version
);
1000 "pdev->params.dcbx_port_params.pfc."
1001 "priority_non_pauseable_mask %x\n",
1002 bp
->dcbx_port_params
.pfc
.priority_non_pauseable_mask
);
1004 for (cos
= 0 ; cos
< bp
->dcbx_port_params
.ets
.num_of_cos
; cos
++) {
1005 DP(NETIF_MSG_LINK
, "pdev->params.dcbx_port_params.ets."
1006 "cos_params[%d].pri_bitmask %x\n", cos
,
1007 bp
->dcbx_port_params
.ets
.cos_params
[cos
].pri_bitmask
);
1009 DP(NETIF_MSG_LINK
, "pdev->params.dcbx_port_params.ets."
1010 "cos_params[%d].bw_tbl %x\n", cos
,
1011 bp
->dcbx_port_params
.ets
.cos_params
[cos
].bw_tbl
);
1013 DP(NETIF_MSG_LINK
, "pdev->params.dcbx_port_params.ets."
1014 "cos_params[%d].strict %x\n", cos
,
1015 bp
->dcbx_port_params
.ets
.cos_params
[cos
].strict
);
1017 DP(NETIF_MSG_LINK
, "pdev->params.dcbx_port_params.ets."
1018 "cos_params[%d].pauseable %x\n", cos
,
1019 bp
->dcbx_port_params
.ets
.cos_params
[cos
].pauseable
);
1022 for (pri
= 0; pri
< LLFC_DRIVER_TRAFFIC_TYPE_MAX
; pri
++) {
1024 "pfc_fw_cfg->traffic_type_to_priority_cos[%d]."
1025 "priority %x\n", pri
,
1026 pfc_fw_cfg
->traffic_type_to_priority_cos
[pri
].priority
);
1029 "pfc_fw_cfg->traffic_type_to_priority_cos[%d].cos %x\n",
1030 pri
, pfc_fw_cfg
->traffic_type_to_priority_cos
[pri
].cos
);
1034 /* fills help_data according to pg_info */
1035 static void bnx2x_dcbx_get_num_pg_traf_type(struct bnx2x
*bp
,
1036 u32
*pg_pri_orginal_spread
,
1037 struct pg_help_data
*help_data
)
1039 bool pg_found
= false;
1040 u32 i
, traf_type
, add_traf_type
, add_pg
;
1041 u32
*ttp
= bp
->dcbx_port_params
.app
.traffic_type_priority
;
1042 struct pg_entry_help_data
*data
= help_data
->data
; /*shotcut*/
1044 /* Set to invalid */
1045 for (i
= 0; i
< LLFC_DRIVER_TRAFFIC_TYPE_MAX
; i
++)
1046 data
[i
].pg
= DCBX_ILLEGAL_PG
;
1048 for (add_traf_type
= 0;
1049 add_traf_type
< LLFC_DRIVER_TRAFFIC_TYPE_MAX
; add_traf_type
++) {
1051 if (ttp
[add_traf_type
] < MAX_PFC_PRIORITIES
) {
1052 add_pg
= (u8
)pg_pri_orginal_spread
[ttp
[add_traf_type
]];
1054 traf_type
< LLFC_DRIVER_TRAFFIC_TYPE_MAX
;
1056 if (data
[traf_type
].pg
== add_pg
) {
1057 if (!(data
[traf_type
].pg_priority
&
1058 (1 << ttp
[add_traf_type
])))
1061 data
[traf_type
].pg_priority
|=
1062 (1 << ttp
[add_traf_type
]);
1067 if (false == pg_found
) {
1068 data
[help_data
->num_of_pg
].pg
= add_pg
;
1069 data
[help_data
->num_of_pg
].pg_priority
=
1070 (1 << ttp
[add_traf_type
]);
1071 data
[help_data
->num_of_pg
].num_of_dif_pri
= 1;
1072 help_data
->num_of_pg
++;
1076 "add_traf_type %d pg_found %s num_of_pg %d\n",
1077 add_traf_type
, (false == pg_found
) ? "NO" : "YES",
1078 help_data
->num_of_pg
);
1083 /*******************************************************************************
1084 * Description: single priority group
1087 ******************************************************************************/
1088 static void bnx2x_dcbx_ets_disabled_entry_data(struct bnx2x
*bp
,
1089 struct cos_help_data
*cos_data
,
1092 /* Only one priority than only one COS */
1093 cos_data
->data
[0].pausable
=
1094 IS_DCBX_PFC_PRI_ONLY_PAUSE(bp
, pri_join_mask
);
1095 cos_data
->data
[0].pri_join_mask
= pri_join_mask
;
1096 cos_data
->data
[0].cos_bw
= 100;
1097 cos_data
->num_of_cos
= 1;
1100 /*******************************************************************************
1101 * Description: updating the cos bw
1104 ******************************************************************************/
1105 static inline void bnx2x_dcbx_add_to_cos_bw(struct bnx2x
*bp
,
1106 struct cos_entry_help_data
*data
,
1109 if (data
->cos_bw
== DCBX_INVALID_COS_BW
)
1110 data
->cos_bw
= pg_bw
;
1112 data
->cos_bw
+= pg_bw
;
1115 /*******************************************************************************
1116 * Description: single priority group
1119 ******************************************************************************/
1120 static void bnx2x_dcbx_separate_pauseable_from_non(struct bnx2x
*bp
,
1121 struct cos_help_data
*cos_data
,
1122 u32
*pg_pri_orginal_spread
,
1123 struct dcbx_ets_feature
*ets
)
1129 u8 num_of_pri
= LLFC_DRIVER_TRAFFIC_TYPE_MAX
;
1131 cos_data
->data
[0].pausable
= true;
1132 cos_data
->data
[1].pausable
= false;
1133 cos_data
->data
[0].pri_join_mask
= cos_data
->data
[1].pri_join_mask
= 0;
1135 for (i
= 0 ; i
< num_of_pri
; i
++) {
1136 pri_tested
= 1 << bp
->dcbx_port_params
.
1137 app
.traffic_type_priority
[i
];
1139 if (pri_tested
& DCBX_PFC_PRI_NON_PAUSE_MASK(bp
)) {
1140 cos_data
->data
[1].pri_join_mask
|= pri_tested
;
1143 cos_data
->data
[0].pri_join_mask
|= pri_tested
;
1146 pg_entry
= (u8
)pg_pri_orginal_spread
[bp
->dcbx_port_params
.
1147 app
.traffic_type_priority
[i
]];
1148 /* There can be only one strict pg */
1149 if (pg_entry
< DCBX_MAX_NUM_PG_BW_ENTRIES
)
1150 bnx2x_dcbx_add_to_cos_bw(bp
, &cos_data
->data
[entry
],
1151 DCBX_PG_BW_GET(ets
->pg_bw_tbl
, pg_entry
));
1153 /* If we join a group and one is strict
1154 * than the bw rulls */
1155 cos_data
->data
[entry
].strict
=
1156 BNX2X_DCBX_COS_HIGH_STRICT
;
1158 if ((0 == cos_data
->data
[0].pri_join_mask
) &&
1159 (0 == cos_data
->data
[1].pri_join_mask
))
1160 BNX2X_ERR("dcbx error: Both groups must have priorities\n");
1165 #define POWER_OF_2(x) ((0 != x) && (0 == (x & (x-1))))
1168 static void bxn2x_dcbx_single_pg_to_cos_params(struct bnx2x
*bp
,
1169 struct pg_help_data
*pg_help_data
,
1170 struct cos_help_data
*cos_data
,
1176 u32 pri_mask_without_pri
= 0;
1177 u32
*ttp
= bp
->dcbx_port_params
.app
.traffic_type_priority
;
1179 if (num_of_dif_pri
== 1) {
1180 bnx2x_dcbx_ets_disabled_entry_data(bp
, cos_data
, pri_join_mask
);
1183 /* single priority group */
1184 if (pg_help_data
->data
[0].pg
< DCBX_MAX_NUM_PG_BW_ENTRIES
) {
1185 /* If there are both pauseable and non-pauseable priorities,
1186 * the pauseable priorities go to the first queue and
1187 * the non-pauseable priorities go to the second queue.
1189 if (IS_DCBX_PFC_PRI_MIX_PAUSE(bp
, pri_join_mask
)) {
1191 cos_data
->data
[0].pausable
= true;
1193 cos_data
->data
[1].pausable
= false;
1195 if (2 == num_of_dif_pri
) {
1196 cos_data
->data
[0].cos_bw
= 50;
1197 cos_data
->data
[1].cos_bw
= 50;
1200 if (3 == num_of_dif_pri
) {
1201 if (POWER_OF_2(DCBX_PFC_PRI_GET_PAUSE(bp
,
1203 cos_data
->data
[0].cos_bw
= 33;
1204 cos_data
->data
[1].cos_bw
= 67;
1206 cos_data
->data
[0].cos_bw
= 67;
1207 cos_data
->data
[1].cos_bw
= 33;
1211 } else if (IS_DCBX_PFC_PRI_ONLY_PAUSE(bp
, pri_join_mask
)) {
1212 /* If there are only pauseable priorities,
1213 * then one/two priorities go to the first queue
1214 * and one priority goes to the second queue.
1216 if (2 == num_of_dif_pri
) {
1217 cos_data
->data
[0].cos_bw
= 50;
1218 cos_data
->data
[1].cos_bw
= 50;
1220 cos_data
->data
[0].cos_bw
= 67;
1221 cos_data
->data
[1].cos_bw
= 33;
1223 cos_data
->data
[1].pausable
= true;
1224 cos_data
->data
[0].pausable
= true;
1225 /* All priorities except FCOE */
1226 cos_data
->data
[0].pri_join_mask
= (pri_join_mask
&
1227 ((u8
)~(1 << ttp
[LLFC_TRAFFIC_TYPE_FCOE
])));
1228 /* Only FCOE priority.*/
1229 cos_data
->data
[1].pri_join_mask
=
1230 (1 << ttp
[LLFC_TRAFFIC_TYPE_FCOE
]);
1232 /* If there are only non-pauseable priorities,
1233 * they will all go to the same queue.
1235 bnx2x_dcbx_ets_disabled_entry_data(bp
,
1236 cos_data
, pri_join_mask
);
1238 /* priority group which is not BW limited (PG#15):*/
1239 if (IS_DCBX_PFC_PRI_MIX_PAUSE(bp
, pri_join_mask
)) {
1240 /* If there are both pauseable and non-pauseable
1241 * priorities, the pauseable priorities go to the first
1242 * queue and the non-pauseable priorities
1243 * go to the second queue.
1245 if (DCBX_PFC_PRI_GET_PAUSE(bp
, pri_join_mask
) >
1246 DCBX_PFC_PRI_GET_NON_PAUSE(bp
, pri_join_mask
)) {
1247 cos_data
->data
[0].strict
=
1248 BNX2X_DCBX_COS_HIGH_STRICT
;
1249 cos_data
->data
[1].strict
=
1250 BNX2X_DCBX_COS_LOW_STRICT
;
1252 cos_data
->data
[0].strict
=
1253 BNX2X_DCBX_COS_LOW_STRICT
;
1254 cos_data
->data
[1].strict
=
1255 BNX2X_DCBX_COS_HIGH_STRICT
;
1258 cos_data
->data
[0].pausable
= true;
1259 /* Non pause-able.*/
1260 cos_data
->data
[1].pausable
= false;
1262 /* If there are only pauseable priorities or
1263 * only non-pauseable,* the lower priorities go
1264 * to the first queue and the higherpriorities go
1265 * to the second queue.
1267 cos_data
->data
[0].pausable
=
1268 cos_data
->data
[1].pausable
=
1269 IS_DCBX_PFC_PRI_ONLY_PAUSE(bp
, pri_join_mask
);
1271 for (i
= 0 ; i
< LLFC_DRIVER_TRAFFIC_TYPE_MAX
; i
++) {
1272 pri_tested
= 1 << bp
->dcbx_port_params
.
1273 app
.traffic_type_priority
[i
];
1274 /* Remove priority tested */
1275 pri_mask_without_pri
=
1276 (pri_join_mask
& ((u8
)(~pri_tested
)));
1277 if (pri_mask_without_pri
< pri_tested
)
1281 if (i
== LLFC_DRIVER_TRAFFIC_TYPE_MAX
)
1282 BNX2X_ERR("Invalid value for pri_join_mask -"
1283 " could not find a priority\n");
1285 cos_data
->data
[0].pri_join_mask
= pri_mask_without_pri
;
1286 cos_data
->data
[1].pri_join_mask
= pri_tested
;
1287 /* Both queues are strict priority,
1288 * and that with the highest priority
1289 * gets the highest strict priority in the arbiter.
1291 cos_data
->data
[0].strict
= BNX2X_DCBX_COS_LOW_STRICT
;
1292 cos_data
->data
[1].strict
= BNX2X_DCBX_COS_HIGH_STRICT
;
1297 static void bnx2x_dcbx_two_pg_to_cos_params(
1299 struct pg_help_data
*pg_help_data
,
1300 struct dcbx_ets_feature
*ets
,
1301 struct cos_help_data
*cos_data
,
1302 u32
*pg_pri_orginal_spread
,
1307 u8 pg
[E2_NUM_OF_COS
] = {0};
1309 /* If there are both pauseable and non-pauseable priorities,
1310 * the pauseable priorities go to the first queue and
1311 * the non-pauseable priorities go to the second queue.
1313 if (IS_DCBX_PFC_PRI_MIX_PAUSE(bp
, pri_join_mask
)) {
1314 if (IS_DCBX_PFC_PRI_MIX_PAUSE(bp
,
1315 pg_help_data
->data
[0].pg_priority
) ||
1316 IS_DCBX_PFC_PRI_MIX_PAUSE(bp
,
1317 pg_help_data
->data
[1].pg_priority
)) {
1318 /* If one PG contains both pauseable and
1319 * non-pauseable priorities then ETS is disabled.
1321 bnx2x_dcbx_separate_pauseable_from_non(bp
, cos_data
,
1322 pg_pri_orginal_spread
, ets
);
1323 bp
->dcbx_port_params
.ets
.enabled
= false;
1328 cos_data
->data
[0].pausable
= true;
1329 /* Non pauseable. */
1330 cos_data
->data
[1].pausable
= false;
1331 if (IS_DCBX_PFC_PRI_ONLY_PAUSE(bp
,
1332 pg_help_data
->data
[0].pg_priority
)) {
1333 /* 0 is pauseable */
1334 cos_data
->data
[0].pri_join_mask
=
1335 pg_help_data
->data
[0].pg_priority
;
1336 pg
[0] = pg_help_data
->data
[0].pg
;
1337 cos_data
->data
[1].pri_join_mask
=
1338 pg_help_data
->data
[1].pg_priority
;
1339 pg
[1] = pg_help_data
->data
[1].pg
;
1340 } else {/* 1 is pauseable */
1341 cos_data
->data
[0].pri_join_mask
=
1342 pg_help_data
->data
[1].pg_priority
;
1343 pg
[0] = pg_help_data
->data
[1].pg
;
1344 cos_data
->data
[1].pri_join_mask
=
1345 pg_help_data
->data
[0].pg_priority
;
1346 pg
[1] = pg_help_data
->data
[0].pg
;
1349 /* If there are only pauseable priorities or
1350 * only non-pauseable, each PG goes to a queue.
1352 cos_data
->data
[0].pausable
= cos_data
->data
[1].pausable
=
1353 IS_DCBX_PFC_PRI_ONLY_PAUSE(bp
, pri_join_mask
);
1354 cos_data
->data
[0].pri_join_mask
=
1355 pg_help_data
->data
[0].pg_priority
;
1356 pg
[0] = pg_help_data
->data
[0].pg
;
1357 cos_data
->data
[1].pri_join_mask
=
1358 pg_help_data
->data
[1].pg_priority
;
1359 pg
[1] = pg_help_data
->data
[1].pg
;
1362 /* There can be only one strict pg */
1363 for (i
= 0 ; i
< E2_NUM_OF_COS
; i
++) {
1364 if (pg
[i
] < DCBX_MAX_NUM_PG_BW_ENTRIES
)
1365 cos_data
->data
[i
].cos_bw
=
1366 DCBX_PG_BW_GET(ets
->pg_bw_tbl
, pg
[i
]);
1368 cos_data
->data
[i
].strict
= BNX2X_DCBX_COS_HIGH_STRICT
;
1372 /*******************************************************************************
1373 * Description: Still
1376 ******************************************************************************/
1377 static void bnx2x_dcbx_three_pg_to_cos_params(
1379 struct pg_help_data
*pg_help_data
,
1380 struct dcbx_ets_feature
*ets
,
1381 struct cos_help_data
*cos_data
,
1382 u32
*pg_pri_orginal_spread
,
1390 bool b_found_strict
= false;
1391 u8 num_of_pri
= LLFC_DRIVER_TRAFFIC_TYPE_MAX
;
1393 cos_data
->data
[0].pri_join_mask
= cos_data
->data
[1].pri_join_mask
= 0;
1394 /* If there are both pauseable and non-pauseable priorities,
1395 * the pauseable priorities go to the first queue and the
1396 * non-pauseable priorities go to the second queue.
1398 if (IS_DCBX_PFC_PRI_MIX_PAUSE(bp
, pri_join_mask
))
1399 bnx2x_dcbx_separate_pauseable_from_non(bp
,
1400 cos_data
, pg_pri_orginal_spread
, ets
);
1402 /* If two BW-limited PG-s were combined to one queue,
1403 * the BW is their sum.
1405 * If there are only pauseable priorities or only non-pauseable,
1406 * and there are both BW-limited and non-BW-limited PG-s,
1407 * the BW-limited PG/s go to one queue and the non-BW-limited
1408 * PG/s go to the second queue.
1410 * If there are only pauseable priorities or only non-pauseable
1411 * and all are BW limited, then two priorities go to the first
1412 * queue and one priority goes to the second queue.
1414 * We will join this two cases:
1415 * if one is BW limited it will go to the secoend queue
1416 * otherwise the last priority will get it
1419 cos_data
->data
[0].pausable
= cos_data
->data
[1].pausable
=
1420 IS_DCBX_PFC_PRI_ONLY_PAUSE(bp
, pri_join_mask
);
1422 for (i
= 0 ; i
< num_of_pri
; i
++) {
1423 pri_tested
= 1 << bp
->dcbx_port_params
.
1424 app
.traffic_type_priority
[i
];
1425 pg_entry
= (u8
)pg_pri_orginal_spread
[bp
->
1426 dcbx_port_params
.app
.traffic_type_priority
[i
]];
1428 if (pg_entry
< DCBX_MAX_NUM_PG_BW_ENTRIES
) {
1431 if (i
== (num_of_pri
-1) &&
1432 false == b_found_strict
)
1433 /* last entry will be handled separately
1434 * If no priority is strict than last
1435 * enty goes to last queue.*/
1437 cos_data
->data
[entry
].pri_join_mask
|=
1439 bnx2x_dcbx_add_to_cos_bw(bp
,
1440 &cos_data
->data
[entry
],
1441 DCBX_PG_BW_GET(ets
->pg_bw_tbl
,
1444 b_found_strict
= true;
1445 cos_data
->data
[1].pri_join_mask
|= pri_tested
;
1446 /* If we join a group and one is strict
1447 * than the bw rulls */
1448 cos_data
->data
[1].strict
=
1449 BNX2X_DCBX_COS_HIGH_STRICT
;
1456 static void bnx2x_dcbx_fill_cos_params(struct bnx2x
*bp
,
1457 struct pg_help_data
*help_data
,
1458 struct dcbx_ets_feature
*ets
,
1459 u32
*pg_pri_orginal_spread
)
1461 struct cos_help_data cos_data
;
1463 u32 pri_join_mask
= 0;
1464 u8 num_of_dif_pri
= 0;
1466 memset(&cos_data
, 0, sizeof(cos_data
));
1467 /* Validate the pg value */
1468 for (i
= 0; i
< help_data
->num_of_pg
; i
++) {
1469 if (DCBX_STRICT_PRIORITY
!= help_data
->data
[i
].pg
&&
1470 DCBX_MAX_NUM_PG_BW_ENTRIES
<= help_data
->data
[i
].pg
)
1471 BNX2X_ERR("Invalid pg[%d] data %x\n", i
,
1472 help_data
->data
[i
].pg
);
1473 pri_join_mask
|= help_data
->data
[i
].pg_priority
;
1474 num_of_dif_pri
+= help_data
->data
[i
].num_of_dif_pri
;
1477 /* default settings */
1478 cos_data
.num_of_cos
= 2;
1479 for (i
= 0; i
< E2_NUM_OF_COS
; i
++) {
1480 cos_data
.data
[i
].pri_join_mask
= pri_join_mask
;
1481 cos_data
.data
[i
].pausable
= false;
1482 cos_data
.data
[i
].strict
= BNX2X_DCBX_COS_NOT_STRICT
;
1483 cos_data
.data
[i
].cos_bw
= DCBX_INVALID_COS_BW
;
1486 switch (help_data
->num_of_pg
) {
1489 bxn2x_dcbx_single_pg_to_cos_params(
1497 bnx2x_dcbx_two_pg_to_cos_params(
1502 pg_pri_orginal_spread
,
1508 bnx2x_dcbx_three_pg_to_cos_params(
1513 pg_pri_orginal_spread
,
1519 BNX2X_ERR("Wrong pg_help_data.num_of_pg\n");
1520 bnx2x_dcbx_ets_disabled_entry_data(bp
,
1521 &cos_data
, pri_join_mask
);
1524 for (i
= 0; i
< cos_data
.num_of_cos
; i
++) {
1525 struct bnx2x_dcbx_cos_params
*params
=
1526 &bp
->dcbx_port_params
.ets
.cos_params
[i
];
1528 params
->pauseable
= cos_data
.data
[i
].pausable
;
1529 params
->strict
= cos_data
.data
[i
].strict
;
1530 params
->bw_tbl
= cos_data
.data
[i
].cos_bw
;
1531 if (params
->pauseable
) {
1532 params
->pri_bitmask
=
1533 DCBX_PFC_PRI_GET_PAUSE(bp
,
1534 cos_data
.data
[i
].pri_join_mask
);
1535 DP(NETIF_MSG_LINK
, "COS %d PAUSABLE prijoinmask 0x%x\n",
1536 i
, cos_data
.data
[i
].pri_join_mask
);
1538 params
->pri_bitmask
=
1539 DCBX_PFC_PRI_GET_NON_PAUSE(bp
,
1540 cos_data
.data
[i
].pri_join_mask
);
1541 DP(NETIF_MSG_LINK
, "COS %d NONPAUSABLE prijoinmask "
1543 i
, cos_data
.data
[i
].pri_join_mask
);
1547 bp
->dcbx_port_params
.ets
.num_of_cos
= cos_data
.num_of_cos
;
1550 static void bnx2x_dcbx_get_ets_pri_pg_tbl(struct bnx2x
*bp
,
1551 u32
*set_configuration_ets_pg
,
1556 for (i
= 0; i
< DCBX_MAX_NUM_PRI_PG_ENTRIES
; i
++) {
1557 set_configuration_ets_pg
[i
] = DCBX_PRI_PG_GET(pri_pg_tbl
, i
);
1559 DP(NETIF_MSG_LINK
, "set_configuration_ets_pg[%d] = 0x%x\n",
1560 i
, set_configuration_ets_pg
[i
]);
1564 /*******************************************************************************
1565 * Description: Fill pfc_config struct that will be sent in DCBX start ramrod
1568 ******************************************************************************/
1569 static void bnx2x_pfc_fw_struct_e2(struct bnx2x
*bp
)
1571 struct flow_control_configuration
*pfc_fw_cfg
= NULL
;
1573 u8 cos
= 0, pri
= 0;
1574 struct priority_cos
*tt2cos
;
1575 u32
*ttp
= bp
->dcbx_port_params
.app
.traffic_type_priority
;
1577 pfc_fw_cfg
= (struct flow_control_configuration
*)
1578 bnx2x_sp(bp
, pfc_config
);
1579 memset(pfc_fw_cfg
, 0, sizeof(struct flow_control_configuration
));
1582 tt2cos
= pfc_fw_cfg
->traffic_type_to_priority_cos
;
1584 /* Fw version should be incremented each update */
1585 pfc_fw_cfg
->dcb_version
= ++bp
->dcb_version
;
1586 pfc_fw_cfg
->dcb_enabled
= DCB_ENABLED
;
1588 /* Default initialization */
1589 for (pri
= 0; pri
< MAX_PFC_TRAFFIC_TYPES
; pri
++) {
1590 tt2cos
[pri
].priority
= LLFC_TRAFFIC_TYPE_TO_PRIORITY_UNMAPPED
;
1591 tt2cos
[pri
].cos
= 0;
1594 /* Fill priority parameters */
1595 for (pri
= 0; pri
< LLFC_DRIVER_TRAFFIC_TYPE_MAX
; pri
++) {
1596 tt2cos
[pri
].priority
= ttp
[pri
];
1597 pri_bit
= 1 << tt2cos
[pri
].priority
;
1599 /* Fill COS parameters based on COS calculated to
1600 * make it more generally for future use */
1601 for (cos
= 0; cos
< bp
->dcbx_port_params
.ets
.num_of_cos
; cos
++)
1602 if (bp
->dcbx_port_params
.ets
.cos_params
[cos
].
1603 pri_bitmask
& pri_bit
)
1604 tt2cos
[pri
].cos
= cos
;
1606 bnx2x_dcbx_print_cos_params(bp
, pfc_fw_cfg
);
1611 #define BNX2X_DCBX_CAPS (DCB_CAP_DCBX_LLD_MANAGED | \
1612 DCB_CAP_DCBX_VER_CEE | DCB_CAP_DCBX_STATIC)
1614 static inline bool bnx2x_dcbnl_set_valid(struct bnx2x
*bp
)
1616 /* validate dcbnl call that may change HW state:
1617 * DCB is on and DCBX mode was SUCCESSFULLY set by the user.
1619 return bp
->dcb_state
&& bp
->dcbx_mode_uset
;
1622 static u8
bnx2x_dcbnl_get_state(struct net_device
*netdev
)
1624 struct bnx2x
*bp
= netdev_priv(netdev
);
1625 DP(NETIF_MSG_LINK
, "state = %d\n", bp
->dcb_state
);
1626 return bp
->dcb_state
;
1629 static u8
bnx2x_dcbnl_set_state(struct net_device
*netdev
, u8 state
)
1631 struct bnx2x
*bp
= netdev_priv(netdev
);
1632 DP(NETIF_MSG_LINK
, "state = %s\n", state
? "on" : "off");
1634 bnx2x_dcbx_set_state(bp
, (state
? true : false), bp
->dcbx_enabled
);
1638 static void bnx2x_dcbnl_get_perm_hw_addr(struct net_device
*netdev
,
1641 struct bnx2x
*bp
= netdev_priv(netdev
);
1642 DP(NETIF_MSG_LINK
, "GET-PERM-ADDR\n");
1644 /* first the HW mac address */
1645 memcpy(perm_addr
, netdev
->dev_addr
, netdev
->addr_len
);
1648 /* second SAN address */
1649 memcpy(perm_addr
+netdev
->addr_len
, bp
->fip_mac
, netdev
->addr_len
);
1653 static void bnx2x_dcbnl_set_pg_tccfg_tx(struct net_device
*netdev
, int prio
,
1654 u8 prio_type
, u8 pgid
, u8 bw_pct
,
1657 struct bnx2x
*bp
= netdev_priv(netdev
);
1659 DP(NETIF_MSG_LINK
, "prio[%d] = %d\n", prio
, pgid
);
1660 if (!bnx2x_dcbnl_set_valid(bp
) || prio
>= DCBX_MAX_NUM_PRI_PG_ENTRIES
)
1664 * bw_pct ingnored - band-width percentage devision between user
1665 * priorities within the same group is not
1666 * standard and hence not supported
1668 * prio_type igonred - priority levels within the same group are not
1669 * standard and hence are not supported. According
1670 * to the standard pgid 15 is dedicated to strict
1671 * prioirty traffic (on the port level).
1676 bp
->dcbx_config_params
.admin_configuration_ets_pg
[prio
] = pgid
;
1677 bp
->dcbx_config_params
.admin_ets_configuration_tx_enable
= 1;
1680 static void bnx2x_dcbnl_set_pg_bwgcfg_tx(struct net_device
*netdev
,
1681 int pgid
, u8 bw_pct
)
1683 struct bnx2x
*bp
= netdev_priv(netdev
);
1684 DP(NETIF_MSG_LINK
, "pgid[%d] = %d\n", pgid
, bw_pct
);
1686 if (!bnx2x_dcbnl_set_valid(bp
) || pgid
>= DCBX_MAX_NUM_PG_BW_ENTRIES
)
1689 bp
->dcbx_config_params
.admin_configuration_bw_precentage
[pgid
] = bw_pct
;
1690 bp
->dcbx_config_params
.admin_ets_configuration_tx_enable
= 1;
1693 static void bnx2x_dcbnl_set_pg_tccfg_rx(struct net_device
*netdev
, int prio
,
1694 u8 prio_type
, u8 pgid
, u8 bw_pct
,
1697 struct bnx2x
*bp
= netdev_priv(netdev
);
1698 DP(NETIF_MSG_LINK
, "Nothing to set; No RX support\n");
1701 static void bnx2x_dcbnl_set_pg_bwgcfg_rx(struct net_device
*netdev
,
1702 int pgid
, u8 bw_pct
)
1704 struct bnx2x
*bp
= netdev_priv(netdev
);
1705 DP(NETIF_MSG_LINK
, "Nothing to set; No RX support\n");
1708 static void bnx2x_dcbnl_get_pg_tccfg_tx(struct net_device
*netdev
, int prio
,
1709 u8
*prio_type
, u8
*pgid
, u8
*bw_pct
,
1712 struct bnx2x
*bp
= netdev_priv(netdev
);
1713 DP(NETIF_MSG_LINK
, "prio = %d\n", prio
);
1716 * bw_pct ingnored - band-width percentage devision between user
1717 * priorities within the same group is not
1718 * standard and hence not supported
1720 * prio_type igonred - priority levels within the same group are not
1721 * standard and hence are not supported. According
1722 * to the standard pgid 15 is dedicated to strict
1723 * prioirty traffic (on the port level).
1727 *up_map
= *bw_pct
= *prio_type
= *pgid
= 0;
1729 if (!bp
->dcb_state
|| prio
>= DCBX_MAX_NUM_PRI_PG_ENTRIES
)
1732 *pgid
= DCBX_PRI_PG_GET(bp
->dcbx_local_feat
.ets
.pri_pg_tbl
, prio
);
1735 static void bnx2x_dcbnl_get_pg_bwgcfg_tx(struct net_device
*netdev
,
1736 int pgid
, u8
*bw_pct
)
1738 struct bnx2x
*bp
= netdev_priv(netdev
);
1739 DP(NETIF_MSG_LINK
, "pgid = %d\n", pgid
);
1743 if (!bp
->dcb_state
|| pgid
>= DCBX_MAX_NUM_PG_BW_ENTRIES
)
1746 *bw_pct
= DCBX_PG_BW_GET(bp
->dcbx_local_feat
.ets
.pg_bw_tbl
, pgid
);
1749 static void bnx2x_dcbnl_get_pg_tccfg_rx(struct net_device
*netdev
, int prio
,
1750 u8
*prio_type
, u8
*pgid
, u8
*bw_pct
,
1753 struct bnx2x
*bp
= netdev_priv(netdev
);
1754 DP(NETIF_MSG_LINK
, "Nothing to get; No RX support\n");
1756 *prio_type
= *pgid
= *bw_pct
= *up_map
= 0;
1759 static void bnx2x_dcbnl_get_pg_bwgcfg_rx(struct net_device
*netdev
,
1760 int pgid
, u8
*bw_pct
)
1762 struct bnx2x
*bp
= netdev_priv(netdev
);
1763 DP(NETIF_MSG_LINK
, "Nothing to get; No RX support\n");
1768 static void bnx2x_dcbnl_set_pfc_cfg(struct net_device
*netdev
, int prio
,
1771 struct bnx2x
*bp
= netdev_priv(netdev
);
1772 DP(NETIF_MSG_LINK
, "prio[%d] = %d\n", prio
, setting
);
1774 if (!bnx2x_dcbnl_set_valid(bp
) || prio
>= MAX_PFC_PRIORITIES
)
1777 bp
->dcbx_config_params
.admin_pfc_bitmap
|= ((setting
? 1 : 0) << prio
);
1780 bp
->dcbx_config_params
.admin_pfc_tx_enable
= 1;
1783 static void bnx2x_dcbnl_get_pfc_cfg(struct net_device
*netdev
, int prio
,
1786 struct bnx2x
*bp
= netdev_priv(netdev
);
1787 DP(NETIF_MSG_LINK
, "prio = %d\n", prio
);
1791 if (!bp
->dcb_state
|| prio
>= MAX_PFC_PRIORITIES
)
1794 *setting
= (bp
->dcbx_local_feat
.pfc
.pri_en_bitmap
>> prio
) & 0x1;
1797 static u8
bnx2x_dcbnl_set_all(struct net_device
*netdev
)
1799 struct bnx2x
*bp
= netdev_priv(netdev
);
1802 DP(NETIF_MSG_LINK
, "SET-ALL\n");
1804 if (!bnx2x_dcbnl_set_valid(bp
))
1807 if (bp
->recovery_state
!= BNX2X_RECOVERY_DONE
) {
1808 netdev_err(bp
->dev
, "Handling parity error recovery. "
1809 "Try again later\n");
1812 if (netif_running(bp
->dev
)) {
1813 bnx2x_nic_unload(bp
, UNLOAD_NORMAL
);
1814 rc
= bnx2x_nic_load(bp
, LOAD_NORMAL
);
1816 DP(NETIF_MSG_LINK
, "set_dcbx_params done (%d)\n", rc
);
1823 static u8
bnx2x_dcbnl_get_cap(struct net_device
*netdev
, int capid
, u8
*cap
)
1825 struct bnx2x
*bp
= netdev_priv(netdev
);
1828 if (bp
->dcb_state
) {
1830 case DCB_CAP_ATTR_PG
:
1833 case DCB_CAP_ATTR_PFC
:
1836 case DCB_CAP_ATTR_UP2TC
:
1839 case DCB_CAP_ATTR_PG_TCS
:
1840 *cap
= 0x80; /* 8 priorities for PGs */
1842 case DCB_CAP_ATTR_PFC_TCS
:
1843 *cap
= 0x80; /* 8 priorities for PFC */
1845 case DCB_CAP_ATTR_GSP
:
1848 case DCB_CAP_ATTR_BCN
:
1851 case DCB_CAP_ATTR_DCBX
:
1852 *cap
= BNX2X_DCBX_CAPS
;
1860 DP(NETIF_MSG_LINK
, "capid %d:%x\n", capid
, *cap
);
1864 static u8
bnx2x_dcbnl_get_numtcs(struct net_device
*netdev
, int tcid
, u8
*num
)
1866 struct bnx2x
*bp
= netdev_priv(netdev
);
1869 DP(NETIF_MSG_LINK
, "tcid %d\n", tcid
);
1871 if (bp
->dcb_state
) {
1873 case DCB_NUMTCS_ATTR_PG
:
1874 *num
= E2_NUM_OF_COS
;
1876 case DCB_NUMTCS_ATTR_PFC
:
1877 *num
= E2_NUM_OF_COS
;
1889 static u8
bnx2x_dcbnl_set_numtcs(struct net_device
*netdev
, int tcid
, u8 num
)
1891 struct bnx2x
*bp
= netdev_priv(netdev
);
1892 DP(NETIF_MSG_LINK
, "num tcs = %d; Not supported\n", num
);
1896 static u8
bnx2x_dcbnl_get_pfc_state(struct net_device
*netdev
)
1898 struct bnx2x
*bp
= netdev_priv(netdev
);
1899 DP(NETIF_MSG_LINK
, "state = %d\n", bp
->dcbx_local_feat
.pfc
.enabled
);
1904 return bp
->dcbx_local_feat
.pfc
.enabled
;
1907 static void bnx2x_dcbnl_set_pfc_state(struct net_device
*netdev
, u8 state
)
1909 struct bnx2x
*bp
= netdev_priv(netdev
);
1910 DP(NETIF_MSG_LINK
, "state = %s\n", state
? "on" : "off");
1912 if (!bnx2x_dcbnl_set_valid(bp
))
1915 bp
->dcbx_config_params
.admin_pfc_tx_enable
=
1916 bp
->dcbx_config_params
.admin_pfc_enable
= (state
? 1 : 0);
1919 static void bnx2x_admin_app_set_ent(
1920 struct bnx2x_admin_priority_app_table
*app_ent
,
1921 u8 idtype
, u16 idval
, u8 up
)
1926 case DCB_APP_IDTYPE_ETHTYPE
:
1927 app_ent
->traffic_type
= TRAFFIC_TYPE_ETH
;
1929 case DCB_APP_IDTYPE_PORTNUM
:
1930 app_ent
->traffic_type
= TRAFFIC_TYPE_PORT
;
1933 break; /* never gets here */
1935 app_ent
->app_id
= idval
;
1936 app_ent
->priority
= up
;
1939 static bool bnx2x_admin_app_is_equal(
1940 struct bnx2x_admin_priority_app_table
*app_ent
,
1941 u8 idtype
, u16 idval
)
1943 if (!app_ent
->valid
)
1947 case DCB_APP_IDTYPE_ETHTYPE
:
1948 if (app_ent
->traffic_type
!= TRAFFIC_TYPE_ETH
)
1951 case DCB_APP_IDTYPE_PORTNUM
:
1952 if (app_ent
->traffic_type
!= TRAFFIC_TYPE_PORT
)
1958 if (app_ent
->app_id
!= idval
)
1964 static int bnx2x_set_admin_app_up(struct bnx2x
*bp
, u8 idtype
, u16 idval
, u8 up
)
1968 /* iterate over the app entries looking for idtype and idval */
1969 for (i
= 0, ff
= -1; i
< 4; i
++) {
1970 struct bnx2x_admin_priority_app_table
*app_ent
=
1971 &bp
->dcbx_config_params
.admin_priority_app_table
[i
];
1972 if (bnx2x_admin_app_is_equal(app_ent
, idtype
, idval
))
1975 if (ff
< 0 && !app_ent
->valid
)
1979 /* if found overwrite up */
1980 bp
->dcbx_config_params
.
1981 admin_priority_app_table
[i
].priority
= up
;
1983 /* not found use first-free */
1984 bnx2x_admin_app_set_ent(
1985 &bp
->dcbx_config_params
.admin_priority_app_table
[ff
],
1988 /* app table is full */
1991 /* up configured, if not 0 make sure feature is enabled */
1993 bp
->dcbx_config_params
.admin_application_priority_tx_enable
= 1;
1998 static u8
bnx2x_dcbnl_set_app_up(struct net_device
*netdev
, u8 idtype
,
2001 struct bnx2x
*bp
= netdev_priv(netdev
);
2003 DP(NETIF_MSG_LINK
, "app_type %d, app_id %x, prio bitmap %d\n",
2006 if (!bnx2x_dcbnl_set_valid(bp
))
2011 case DCB_APP_IDTYPE_ETHTYPE
:
2012 case DCB_APP_IDTYPE_PORTNUM
:
2017 return bnx2x_set_admin_app_up(bp
, idtype
, idval
, up
);
2020 static u8
bnx2x_dcbnl_get_dcbx(struct net_device
*netdev
)
2022 struct bnx2x
*bp
= netdev_priv(netdev
);
2025 state
= DCB_CAP_DCBX_LLD_MANAGED
| DCB_CAP_DCBX_VER_CEE
;
2027 if (bp
->dcbx_enabled
== BNX2X_DCBX_ENABLED_ON_NEG_OFF
)
2028 state
|= DCB_CAP_DCBX_STATIC
;
2033 static u8
bnx2x_dcbnl_set_dcbx(struct net_device
*netdev
, u8 state
)
2035 struct bnx2x
*bp
= netdev_priv(netdev
);
2036 DP(NETIF_MSG_LINK
, "state = %02x\n", state
);
2040 if ((state
& BNX2X_DCBX_CAPS
) != state
) {
2041 BNX2X_ERR("Requested DCBX mode %x is beyond advertised "
2042 "capabilities\n", state
);
2046 if (bp
->dcb_state
!= BNX2X_DCB_STATE_ON
) {
2047 BNX2X_ERR("DCB turned off, DCBX configuration is invalid\n");
2051 if (state
& DCB_CAP_DCBX_STATIC
)
2052 bp
->dcbx_enabled
= BNX2X_DCBX_ENABLED_ON_NEG_OFF
;
2054 bp
->dcbx_enabled
= BNX2X_DCBX_ENABLED_ON_NEG_ON
;
2056 bp
->dcbx_mode_uset
= true;
2061 static u8
bnx2x_dcbnl_get_featcfg(struct net_device
*netdev
, int featid
,
2064 struct bnx2x
*bp
= netdev_priv(netdev
);
2067 DP(NETIF_MSG_LINK
, "featid %d\n", featid
);
2069 if (bp
->dcb_state
) {
2072 case DCB_FEATCFG_ATTR_PG
:
2073 if (bp
->dcbx_local_feat
.ets
.enabled
)
2074 *flags
|= DCB_FEATCFG_ENABLE
;
2075 if (bp
->dcbx_error
& DCBX_LOCAL_ETS_ERROR
)
2076 *flags
|= DCB_FEATCFG_ERROR
;
2078 case DCB_FEATCFG_ATTR_PFC
:
2079 if (bp
->dcbx_local_feat
.pfc
.enabled
)
2080 *flags
|= DCB_FEATCFG_ENABLE
;
2081 if (bp
->dcbx_error
& (DCBX_LOCAL_PFC_ERROR
|
2082 DCBX_LOCAL_PFC_MISMATCH
))
2083 *flags
|= DCB_FEATCFG_ERROR
;
2085 case DCB_FEATCFG_ATTR_APP
:
2086 if (bp
->dcbx_local_feat
.app
.enabled
)
2087 *flags
|= DCB_FEATCFG_ENABLE
;
2088 if (bp
->dcbx_error
& (DCBX_LOCAL_APP_ERROR
|
2089 DCBX_LOCAL_APP_MISMATCH
))
2090 *flags
|= DCB_FEATCFG_ERROR
;
2102 static u8
bnx2x_dcbnl_set_featcfg(struct net_device
*netdev
, int featid
,
2105 struct bnx2x
*bp
= netdev_priv(netdev
);
2108 DP(NETIF_MSG_LINK
, "featid = %d flags = %02x\n", featid
, flags
);
2110 /* ignore the 'advertise' flag */
2111 if (bnx2x_dcbnl_set_valid(bp
)) {
2113 case DCB_FEATCFG_ATTR_PG
:
2114 bp
->dcbx_config_params
.admin_ets_enable
=
2115 flags
& DCB_FEATCFG_ENABLE
? 1 : 0;
2116 bp
->dcbx_config_params
.admin_ets_willing
=
2117 flags
& DCB_FEATCFG_WILLING
? 1 : 0;
2119 case DCB_FEATCFG_ATTR_PFC
:
2120 bp
->dcbx_config_params
.admin_pfc_enable
=
2121 flags
& DCB_FEATCFG_ENABLE
? 1 : 0;
2122 bp
->dcbx_config_params
.admin_pfc_willing
=
2123 flags
& DCB_FEATCFG_WILLING
? 1 : 0;
2125 case DCB_FEATCFG_ATTR_APP
:
2126 /* ignore enable, always enabled */
2127 bp
->dcbx_config_params
.admin_app_priority_willing
=
2128 flags
& DCB_FEATCFG_WILLING
? 1 : 0;
2140 const struct dcbnl_rtnl_ops bnx2x_dcbnl_ops
= {
2141 .getstate
= bnx2x_dcbnl_get_state
,
2142 .setstate
= bnx2x_dcbnl_set_state
,
2143 .getpermhwaddr
= bnx2x_dcbnl_get_perm_hw_addr
,
2144 .setpgtccfgtx
= bnx2x_dcbnl_set_pg_tccfg_tx
,
2145 .setpgbwgcfgtx
= bnx2x_dcbnl_set_pg_bwgcfg_tx
,
2146 .setpgtccfgrx
= bnx2x_dcbnl_set_pg_tccfg_rx
,
2147 .setpgbwgcfgrx
= bnx2x_dcbnl_set_pg_bwgcfg_rx
,
2148 .getpgtccfgtx
= bnx2x_dcbnl_get_pg_tccfg_tx
,
2149 .getpgbwgcfgtx
= bnx2x_dcbnl_get_pg_bwgcfg_tx
,
2150 .getpgtccfgrx
= bnx2x_dcbnl_get_pg_tccfg_rx
,
2151 .getpgbwgcfgrx
= bnx2x_dcbnl_get_pg_bwgcfg_rx
,
2152 .setpfccfg
= bnx2x_dcbnl_set_pfc_cfg
,
2153 .getpfccfg
= bnx2x_dcbnl_get_pfc_cfg
,
2154 .setall
= bnx2x_dcbnl_set_all
,
2155 .getcap
= bnx2x_dcbnl_get_cap
,
2156 .getnumtcs
= bnx2x_dcbnl_get_numtcs
,
2157 .setnumtcs
= bnx2x_dcbnl_set_numtcs
,
2158 .getpfcstate
= bnx2x_dcbnl_get_pfc_state
,
2159 .setpfcstate
= bnx2x_dcbnl_set_pfc_state
,
2160 .setapp
= bnx2x_dcbnl_set_app_up
,
2161 .getdcbx
= bnx2x_dcbnl_get_dcbx
,
2162 .setdcbx
= bnx2x_dcbnl_set_dcbx
,
2163 .getfeatcfg
= bnx2x_dcbnl_get_featcfg
,
2164 .setfeatcfg
= bnx2x_dcbnl_set_featcfg
,
2167 #endif /* BCM_DCBNL */