1 /* Copyright 2008-2013 Broadcom Corporation
3 * Unless you and Broadcom execute a separate written software license
4 * agreement governing use of this software, this software is licensed to you
5 * under the terms of the GNU General Public License version 2, available
6 * at http://www.gnu.org/licenses/old-licenses/gpl-2.0.html (the "GPL").
8 * Notwithstanding the above, under no circumstances may you combine this
9 * software in any way with any other Broadcom software provided under a
10 * license other than the GPL, without Broadcom's express prior written
13 * Written by Yaniv Rosner
17 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
19 #include <linux/kernel.h>
20 #include <linux/errno.h>
21 #include <linux/pci.h>
22 #include <linux/netdevice.h>
23 #include <linux/delay.h>
24 #include <linux/ethtool.h>
25 #include <linux/mutex.h>
28 #include "bnx2x_cmn.h"
30 /********************************************************/
32 /* L2 header size + 2*VLANs (8 bytes) + LLC SNAP (8 bytes) */
33 #define ETH_OVREHEAD (ETH_HLEN + 8 + 8)
34 #define ETH_MIN_PACKET_SIZE 60
35 #define ETH_MAX_PACKET_SIZE 1500
36 #define ETH_MAX_JUMBO_PACKET_SIZE 9600
37 #define MDIO_ACCESS_TIMEOUT 1000
39 #define I2C_SWITCH_WIDTH 2
42 #define I2C_WA_RETRY_CNT 3
43 #define I2C_WA_PWR_ITER (I2C_WA_RETRY_CNT - 1)
44 #define MCPR_IMC_COMMAND_READ_OP 1
45 #define MCPR_IMC_COMMAND_WRITE_OP 2
47 /* LED Blink rate that will achieve ~15.9Hz */
48 #define LED_BLINK_RATE_VAL_E3 354
49 #define LED_BLINK_RATE_VAL_E1X_E2 480
50 /***********************************************************/
51 /* Shortcut definitions */
52 /***********************************************************/
54 #define NIG_LATCH_BC_ENABLE_MI_INT 0
56 #define NIG_STATUS_EMAC0_MI_INT \
57 NIG_STATUS_INTERRUPT_PORT0_REG_STATUS_EMAC0_MISC_MI_INT
58 #define NIG_STATUS_XGXS0_LINK10G \
59 NIG_STATUS_INTERRUPT_PORT0_REG_STATUS_XGXS0_LINK10G
60 #define NIG_STATUS_XGXS0_LINK_STATUS \
61 NIG_STATUS_INTERRUPT_PORT0_REG_STATUS_XGXS0_LINK_STATUS
62 #define NIG_STATUS_XGXS0_LINK_STATUS_SIZE \
63 NIG_STATUS_INTERRUPT_PORT0_REG_STATUS_XGXS0_LINK_STATUS_SIZE
64 #define NIG_STATUS_SERDES0_LINK_STATUS \
65 NIG_STATUS_INTERRUPT_PORT0_REG_STATUS_SERDES0_LINK_STATUS
66 #define NIG_MASK_MI_INT \
67 NIG_MASK_INTERRUPT_PORT0_REG_MASK_EMAC0_MISC_MI_INT
68 #define NIG_MASK_XGXS0_LINK10G \
69 NIG_MASK_INTERRUPT_PORT0_REG_MASK_XGXS0_LINK10G
70 #define NIG_MASK_XGXS0_LINK_STATUS \
71 NIG_MASK_INTERRUPT_PORT0_REG_MASK_XGXS0_LINK_STATUS
72 #define NIG_MASK_SERDES0_LINK_STATUS \
73 NIG_MASK_INTERRUPT_PORT0_REG_MASK_SERDES0_LINK_STATUS
75 #define MDIO_AN_CL73_OR_37_COMPLETE \
76 (MDIO_GP_STATUS_TOP_AN_STATUS1_CL73_AUTONEG_COMPLETE | \
77 MDIO_GP_STATUS_TOP_AN_STATUS1_CL37_AUTONEG_COMPLETE)
79 #define XGXS_RESET_BITS \
80 (MISC_REGISTERS_RESET_REG_3_MISC_NIG_MUX_XGXS0_RSTB_HW | \
81 MISC_REGISTERS_RESET_REG_3_MISC_NIG_MUX_XGXS0_IDDQ | \
82 MISC_REGISTERS_RESET_REG_3_MISC_NIG_MUX_XGXS0_PWRDWN | \
83 MISC_REGISTERS_RESET_REG_3_MISC_NIG_MUX_XGXS0_PWRDWN_SD | \
84 MISC_REGISTERS_RESET_REG_3_MISC_NIG_MUX_XGXS0_TXD_FIFO_RSTB)
86 #define SERDES_RESET_BITS \
87 (MISC_REGISTERS_RESET_REG_3_MISC_NIG_MUX_SERDES0_RSTB_HW | \
88 MISC_REGISTERS_RESET_REG_3_MISC_NIG_MUX_SERDES0_IDDQ | \
89 MISC_REGISTERS_RESET_REG_3_MISC_NIG_MUX_SERDES0_PWRDWN | \
90 MISC_REGISTERS_RESET_REG_3_MISC_NIG_MUX_SERDES0_PWRDWN_SD)
92 #define AUTONEG_CL37 SHARED_HW_CFG_AN_ENABLE_CL37
93 #define AUTONEG_CL73 SHARED_HW_CFG_AN_ENABLE_CL73
94 #define AUTONEG_BAM SHARED_HW_CFG_AN_ENABLE_BAM
95 #define AUTONEG_PARALLEL \
96 SHARED_HW_CFG_AN_ENABLE_PARALLEL_DETECTION
97 #define AUTONEG_SGMII_FIBER_AUTODET \
98 SHARED_HW_CFG_AN_EN_SGMII_FIBER_AUTO_DETECT
99 #define AUTONEG_REMOTE_PHY SHARED_HW_CFG_AN_ENABLE_REMOTE_PHY
101 #define GP_STATUS_PAUSE_RSOLUTION_TXSIDE \
102 MDIO_GP_STATUS_TOP_AN_STATUS1_PAUSE_RSOLUTION_TXSIDE
103 #define GP_STATUS_PAUSE_RSOLUTION_RXSIDE \
104 MDIO_GP_STATUS_TOP_AN_STATUS1_PAUSE_RSOLUTION_RXSIDE
105 #define GP_STATUS_SPEED_MASK \
106 MDIO_GP_STATUS_TOP_AN_STATUS1_ACTUAL_SPEED_MASK
107 #define GP_STATUS_10M MDIO_GP_STATUS_TOP_AN_STATUS1_ACTUAL_SPEED_10M
108 #define GP_STATUS_100M MDIO_GP_STATUS_TOP_AN_STATUS1_ACTUAL_SPEED_100M
109 #define GP_STATUS_1G MDIO_GP_STATUS_TOP_AN_STATUS1_ACTUAL_SPEED_1G
110 #define GP_STATUS_2_5G MDIO_GP_STATUS_TOP_AN_STATUS1_ACTUAL_SPEED_2_5G
111 #define GP_STATUS_5G MDIO_GP_STATUS_TOP_AN_STATUS1_ACTUAL_SPEED_5G
112 #define GP_STATUS_6G MDIO_GP_STATUS_TOP_AN_STATUS1_ACTUAL_SPEED_6G
113 #define GP_STATUS_10G_HIG \
114 MDIO_GP_STATUS_TOP_AN_STATUS1_ACTUAL_SPEED_10G_HIG
115 #define GP_STATUS_10G_CX4 \
116 MDIO_GP_STATUS_TOP_AN_STATUS1_ACTUAL_SPEED_10G_CX4
117 #define GP_STATUS_1G_KX MDIO_GP_STATUS_TOP_AN_STATUS1_ACTUAL_SPEED_1G_KX
118 #define GP_STATUS_10G_KX4 \
119 MDIO_GP_STATUS_TOP_AN_STATUS1_ACTUAL_SPEED_10G_KX4
120 #define GP_STATUS_10G_KR MDIO_GP_STATUS_TOP_AN_STATUS1_ACTUAL_SPEED_10G_KR
121 #define GP_STATUS_10G_XFI MDIO_GP_STATUS_TOP_AN_STATUS1_ACTUAL_SPEED_10G_XFI
122 #define GP_STATUS_20G_DXGXS MDIO_GP_STATUS_TOP_AN_STATUS1_ACTUAL_SPEED_20G_DXGXS
123 #define GP_STATUS_10G_SFI MDIO_GP_STATUS_TOP_AN_STATUS1_ACTUAL_SPEED_10G_SFI
124 #define GP_STATUS_20G_KR2 MDIO_GP_STATUS_TOP_AN_STATUS1_ACTUAL_SPEED_20G_KR2
125 #define LINK_10THD LINK_STATUS_SPEED_AND_DUPLEX_10THD
126 #define LINK_10TFD LINK_STATUS_SPEED_AND_DUPLEX_10TFD
127 #define LINK_100TXHD LINK_STATUS_SPEED_AND_DUPLEX_100TXHD
128 #define LINK_100T4 LINK_STATUS_SPEED_AND_DUPLEX_100T4
129 #define LINK_100TXFD LINK_STATUS_SPEED_AND_DUPLEX_100TXFD
130 #define LINK_1000THD LINK_STATUS_SPEED_AND_DUPLEX_1000THD
131 #define LINK_1000TFD LINK_STATUS_SPEED_AND_DUPLEX_1000TFD
132 #define LINK_1000XFD LINK_STATUS_SPEED_AND_DUPLEX_1000XFD
133 #define LINK_2500THD LINK_STATUS_SPEED_AND_DUPLEX_2500THD
134 #define LINK_2500TFD LINK_STATUS_SPEED_AND_DUPLEX_2500TFD
135 #define LINK_2500XFD LINK_STATUS_SPEED_AND_DUPLEX_2500XFD
136 #define LINK_10GTFD LINK_STATUS_SPEED_AND_DUPLEX_10GTFD
137 #define LINK_10GXFD LINK_STATUS_SPEED_AND_DUPLEX_10GXFD
138 #define LINK_20GTFD LINK_STATUS_SPEED_AND_DUPLEX_20GTFD
139 #define LINK_20GXFD LINK_STATUS_SPEED_AND_DUPLEX_20GXFD
141 #define LINK_UPDATE_MASK \
142 (LINK_STATUS_SPEED_AND_DUPLEX_MASK | \
143 LINK_STATUS_LINK_UP | \
144 LINK_STATUS_PHYSICAL_LINK_FLAG | \
145 LINK_STATUS_AUTO_NEGOTIATE_COMPLETE | \
146 LINK_STATUS_RX_FLOW_CONTROL_FLAG_MASK | \
147 LINK_STATUS_TX_FLOW_CONTROL_FLAG_MASK | \
148 LINK_STATUS_PARALLEL_DETECTION_FLAG_MASK | \
149 LINK_STATUS_LINK_PARTNER_SYMMETRIC_PAUSE | \
150 LINK_STATUS_LINK_PARTNER_ASYMMETRIC_PAUSE)
152 #define SFP_EEPROM_CON_TYPE_ADDR 0x2
153 #define SFP_EEPROM_CON_TYPE_VAL_LC 0x7
154 #define SFP_EEPROM_CON_TYPE_VAL_COPPER 0x21
157 #define SFP_EEPROM_COMP_CODE_ADDR 0x3
158 #define SFP_EEPROM_COMP_CODE_SR_MASK (1<<4)
159 #define SFP_EEPROM_COMP_CODE_LR_MASK (1<<5)
160 #define SFP_EEPROM_COMP_CODE_LRM_MASK (1<<6)
162 #define SFP_EEPROM_FC_TX_TECH_ADDR 0x8
163 #define SFP_EEPROM_FC_TX_TECH_BITMASK_COPPER_PASSIVE 0x4
164 #define SFP_EEPROM_FC_TX_TECH_BITMASK_COPPER_ACTIVE 0x8
166 #define SFP_EEPROM_OPTIONS_ADDR 0x40
167 #define SFP_EEPROM_OPTIONS_LINEAR_RX_OUT_MASK 0x1
168 #define SFP_EEPROM_OPTIONS_SIZE 2
170 #define EDC_MODE_LINEAR 0x0022
171 #define EDC_MODE_LIMITING 0x0044
172 #define EDC_MODE_PASSIVE_DAC 0x0055
175 #define DCBX_INVALID_COS (0xFF)
177 #define ETS_BW_LIMIT_CREDIT_UPPER_BOUND (0x5000)
178 #define ETS_BW_LIMIT_CREDIT_WEIGHT (0x5000)
179 #define ETS_E3B0_NIG_MIN_W_VAL_UP_TO_10GBPS (1360)
180 #define ETS_E3B0_NIG_MIN_W_VAL_20GBPS (2720)
181 #define ETS_E3B0_PBF_MIN_W_VAL (10000)
183 #define MAX_PACKET_SIZE (9700)
184 #define MAX_KR_LINK_RETRY 4
186 /**********************************************************/
188 /**********************************************************/
190 #define CL22_WR_OVER_CL45(_bp, _phy, _bank, _addr, _val) \
191 bnx2x_cl45_write(_bp, _phy, \
192 (_phy)->def_md_devad, \
193 (_bank + (_addr & 0xf)), \
196 #define CL22_RD_OVER_CL45(_bp, _phy, _bank, _addr, _val) \
197 bnx2x_cl45_read(_bp, _phy, \
198 (_phy)->def_md_devad, \
199 (_bank + (_addr & 0xf)), \
202 static u32
bnx2x_bits_en(struct bnx2x
*bp
, u32 reg
, u32 bits
)
204 u32 val
= REG_RD(bp
, reg
);
207 REG_WR(bp
, reg
, val
);
211 static u32
bnx2x_bits_dis(struct bnx2x
*bp
, u32 reg
, u32 bits
)
213 u32 val
= REG_RD(bp
, reg
);
216 REG_WR(bp
, reg
, val
);
221 * bnx2x_check_lfa - This function checks if link reinitialization is required,
222 * or link flap can be avoided.
224 * @params: link parameters
225 * Returns 0 if Link Flap Avoidance conditions are met otherwise, the failed
228 static int bnx2x_check_lfa(struct link_params
*params
)
230 u32 link_status
, cfg_idx
, lfa_mask
, cfg_size
;
231 u32 cur_speed_cap_mask
, cur_req_fc_auto_adv
, additional_config
;
232 u32 saved_val
, req_val
, eee_status
;
233 struct bnx2x
*bp
= params
->bp
;
236 REG_RD(bp
, params
->lfa_base
+
237 offsetof(struct shmem_lfa
, additional_config
));
239 /* NOTE: must be first condition checked -
240 * to verify DCC bit is cleared in any case!
242 if (additional_config
& NO_LFA_DUE_TO_DCC_MASK
) {
243 DP(NETIF_MSG_LINK
, "No LFA due to DCC flap after clp exit\n");
244 REG_WR(bp
, params
->lfa_base
+
245 offsetof(struct shmem_lfa
, additional_config
),
246 additional_config
& ~NO_LFA_DUE_TO_DCC_MASK
);
247 return LFA_DCC_LFA_DISABLED
;
250 /* Verify that link is up */
251 link_status
= REG_RD(bp
, params
->shmem_base
+
252 offsetof(struct shmem_region
,
253 port_mb
[params
->port
].link_status
));
254 if (!(link_status
& LINK_STATUS_LINK_UP
))
255 return LFA_LINK_DOWN
;
257 /* if loaded after BOOT from SAN, don't flap the link in any case and
258 * rely on link set by preboot driver
260 if (params
->feature_config_flags
& FEATURE_CONFIG_BOOT_FROM_SAN
)
263 /* Verify that loopback mode is not set */
264 if (params
->loopback_mode
)
265 return LFA_LOOPBACK_ENABLED
;
267 /* Verify that MFW supports LFA */
268 if (!params
->lfa_base
)
269 return LFA_MFW_IS_TOO_OLD
;
271 if (params
->num_phys
== 3) {
273 lfa_mask
= 0xffffffff;
280 saved_val
= REG_RD(bp
, params
->lfa_base
+
281 offsetof(struct shmem_lfa
, req_duplex
));
282 req_val
= params
->req_duplex
[0] | (params
->req_duplex
[1] << 16);
283 if ((saved_val
& lfa_mask
) != (req_val
& lfa_mask
)) {
284 DP(NETIF_MSG_LINK
, "Duplex mismatch %x vs. %x\n",
285 (saved_val
& lfa_mask
), (req_val
& lfa_mask
));
286 return LFA_DUPLEX_MISMATCH
;
288 /* Compare Flow Control */
289 saved_val
= REG_RD(bp
, params
->lfa_base
+
290 offsetof(struct shmem_lfa
, req_flow_ctrl
));
291 req_val
= params
->req_flow_ctrl
[0] | (params
->req_flow_ctrl
[1] << 16);
292 if ((saved_val
& lfa_mask
) != (req_val
& lfa_mask
)) {
293 DP(NETIF_MSG_LINK
, "Flow control mismatch %x vs. %x\n",
294 (saved_val
& lfa_mask
), (req_val
& lfa_mask
));
295 return LFA_FLOW_CTRL_MISMATCH
;
297 /* Compare Link Speed */
298 saved_val
= REG_RD(bp
, params
->lfa_base
+
299 offsetof(struct shmem_lfa
, req_line_speed
));
300 req_val
= params
->req_line_speed
[0] | (params
->req_line_speed
[1] << 16);
301 if ((saved_val
& lfa_mask
) != (req_val
& lfa_mask
)) {
302 DP(NETIF_MSG_LINK
, "Link speed mismatch %x vs. %x\n",
303 (saved_val
& lfa_mask
), (req_val
& lfa_mask
));
304 return LFA_LINK_SPEED_MISMATCH
;
307 for (cfg_idx
= 0; cfg_idx
< cfg_size
; cfg_idx
++) {
308 cur_speed_cap_mask
= REG_RD(bp
, params
->lfa_base
+
309 offsetof(struct shmem_lfa
,
310 speed_cap_mask
[cfg_idx
]));
312 if (cur_speed_cap_mask
!= params
->speed_cap_mask
[cfg_idx
]) {
313 DP(NETIF_MSG_LINK
, "Speed Cap mismatch %x vs. %x\n",
315 params
->speed_cap_mask
[cfg_idx
]);
316 return LFA_SPEED_CAP_MISMATCH
;
320 cur_req_fc_auto_adv
=
321 REG_RD(bp
, params
->lfa_base
+
322 offsetof(struct shmem_lfa
, additional_config
)) &
323 REQ_FC_AUTO_ADV_MASK
;
325 if ((u16
)cur_req_fc_auto_adv
!= params
->req_fc_auto_adv
) {
326 DP(NETIF_MSG_LINK
, "Flow Ctrl AN mismatch %x vs. %x\n",
327 cur_req_fc_auto_adv
, params
->req_fc_auto_adv
);
328 return LFA_FLOW_CTRL_MISMATCH
;
331 eee_status
= REG_RD(bp
, params
->shmem2_base
+
332 offsetof(struct shmem2_region
,
333 eee_status
[params
->port
]));
335 if (((eee_status
& SHMEM_EEE_LPI_REQUESTED_BIT
) ^
336 (params
->eee_mode
& EEE_MODE_ENABLE_LPI
)) ||
337 ((eee_status
& SHMEM_EEE_REQUESTED_BIT
) ^
338 (params
->eee_mode
& EEE_MODE_ADV_LPI
))) {
339 DP(NETIF_MSG_LINK
, "EEE mismatch %x vs. %x\n", params
->eee_mode
,
341 return LFA_EEE_MISMATCH
;
344 /* LFA conditions are met */
347 /******************************************************************/
348 /* EPIO/GPIO section */
349 /******************************************************************/
350 static void bnx2x_get_epio(struct bnx2x
*bp
, u32 epio_pin
, u32
*en
)
352 u32 epio_mask
, gp_oenable
;
356 DP(NETIF_MSG_LINK
, "Invalid EPIO pin %d to get\n", epio_pin
);
360 epio_mask
= 1 << epio_pin
;
361 /* Set this EPIO to output */
362 gp_oenable
= REG_RD(bp
, MCP_REG_MCPR_GP_OENABLE
);
363 REG_WR(bp
, MCP_REG_MCPR_GP_OENABLE
, gp_oenable
& ~epio_mask
);
365 *en
= (REG_RD(bp
, MCP_REG_MCPR_GP_INPUTS
) & epio_mask
) >> epio_pin
;
367 static void bnx2x_set_epio(struct bnx2x
*bp
, u32 epio_pin
, u32 en
)
369 u32 epio_mask
, gp_output
, gp_oenable
;
373 DP(NETIF_MSG_LINK
, "Invalid EPIO pin %d to set\n", epio_pin
);
376 DP(NETIF_MSG_LINK
, "Setting EPIO pin %d to %d\n", epio_pin
, en
);
377 epio_mask
= 1 << epio_pin
;
378 /* Set this EPIO to output */
379 gp_output
= REG_RD(bp
, MCP_REG_MCPR_GP_OUTPUTS
);
381 gp_output
|= epio_mask
;
383 gp_output
&= ~epio_mask
;
385 REG_WR(bp
, MCP_REG_MCPR_GP_OUTPUTS
, gp_output
);
387 /* Set the value for this EPIO */
388 gp_oenable
= REG_RD(bp
, MCP_REG_MCPR_GP_OENABLE
);
389 REG_WR(bp
, MCP_REG_MCPR_GP_OENABLE
, gp_oenable
| epio_mask
);
392 static void bnx2x_set_cfg_pin(struct bnx2x
*bp
, u32 pin_cfg
, u32 val
)
394 if (pin_cfg
== PIN_CFG_NA
)
396 if (pin_cfg
>= PIN_CFG_EPIO0
) {
397 bnx2x_set_epio(bp
, pin_cfg
- PIN_CFG_EPIO0
, val
);
399 u8 gpio_num
= (pin_cfg
- PIN_CFG_GPIO0_P0
) & 0x3;
400 u8 gpio_port
= (pin_cfg
- PIN_CFG_GPIO0_P0
) >> 2;
401 bnx2x_set_gpio(bp
, gpio_num
, (u8
)val
, gpio_port
);
405 static u32
bnx2x_get_cfg_pin(struct bnx2x
*bp
, u32 pin_cfg
, u32
*val
)
407 if (pin_cfg
== PIN_CFG_NA
)
409 if (pin_cfg
>= PIN_CFG_EPIO0
) {
410 bnx2x_get_epio(bp
, pin_cfg
- PIN_CFG_EPIO0
, val
);
412 u8 gpio_num
= (pin_cfg
- PIN_CFG_GPIO0_P0
) & 0x3;
413 u8 gpio_port
= (pin_cfg
- PIN_CFG_GPIO0_P0
) >> 2;
414 *val
= bnx2x_get_gpio(bp
, gpio_num
, gpio_port
);
419 /******************************************************************/
421 /******************************************************************/
422 static void bnx2x_ets_e2e3a0_disabled(struct link_params
*params
)
424 /* ETS disabled configuration*/
425 struct bnx2x
*bp
= params
->bp
;
427 DP(NETIF_MSG_LINK
, "ETS E2E3 disabled configuration\n");
429 /* mapping between entry priority to client number (0,1,2 -debug and
430 * management clients, 3 - COS0 client, 4 - COS client)(HIGHEST)
432 * PRI4 | PRI3 | PRI2 | PRI1 | PRI0
433 * cos1-100 cos0-011 dbg1-010 dbg0-001 MCP-000
436 REG_WR(bp
, NIG_REG_P0_TX_ARB_PRIORITY_CLIENT
, 0x4688);
437 /* Bitmap of 5bits length. Each bit specifies whether the entry behaves
438 * as strict. Bits 0,1,2 - debug and management entries, 3 -
439 * COS0 entry, 4 - COS1 entry.
440 * COS1 | COS0 | DEBUG1 | DEBUG0 | MGMT
441 * bit4 bit3 bit2 bit1 bit0
442 * MCP and debug are strict
445 REG_WR(bp
, NIG_REG_P0_TX_ARB_CLIENT_IS_STRICT
, 0x7);
446 /* defines which entries (clients) are subjected to WFQ arbitration */
447 REG_WR(bp
, NIG_REG_P0_TX_ARB_CLIENT_IS_SUBJECT2WFQ
, 0);
448 /* For strict priority entries defines the number of consecutive
449 * slots for the highest priority.
451 REG_WR(bp
, NIG_REG_P0_TX_ARB_NUM_STRICT_ARB_SLOTS
, 0x100);
452 /* mapping between the CREDIT_WEIGHT registers and actual client
455 REG_WR(bp
, NIG_REG_P0_TX_ARB_CLIENT_CREDIT_MAP
, 0);
456 REG_WR(bp
, NIG_REG_P0_TX_ARB_CREDIT_WEIGHT_0
, 0);
457 REG_WR(bp
, NIG_REG_P0_TX_ARB_CREDIT_WEIGHT_1
, 0);
459 REG_WR(bp
, NIG_REG_P0_TX_ARB_CREDIT_UPPER_BOUND_0
, 0);
460 REG_WR(bp
, NIG_REG_P0_TX_ARB_CREDIT_UPPER_BOUND_1
, 0);
461 REG_WR(bp
, PBF_REG_HIGH_PRIORITY_COS_NUM
, 0);
462 /* ETS mode disable */
463 REG_WR(bp
, PBF_REG_ETS_ENABLED
, 0);
464 /* If ETS mode is enabled (there is no strict priority) defines a WFQ
465 * weight for COS0/COS1.
467 REG_WR(bp
, PBF_REG_COS0_WEIGHT
, 0x2710);
468 REG_WR(bp
, PBF_REG_COS1_WEIGHT
, 0x2710);
469 /* Upper bound that COS0_WEIGHT can reach in the WFQ arbiter */
470 REG_WR(bp
, PBF_REG_COS0_UPPER_BOUND
, 0x989680);
471 REG_WR(bp
, PBF_REG_COS1_UPPER_BOUND
, 0x989680);
472 /* Defines the number of consecutive slots for the strict priority */
473 REG_WR(bp
, PBF_REG_NUM_STRICT_ARB_SLOTS
, 0);
475 /******************************************************************************
477 * Getting min_w_val will be set according to line speed .
479 ******************************************************************************/
480 static u32
bnx2x_ets_get_min_w_val_nig(const struct link_vars
*vars
)
483 /* Calculate min_w_val.*/
485 if (vars
->line_speed
== SPEED_20000
)
486 min_w_val
= ETS_E3B0_NIG_MIN_W_VAL_20GBPS
;
488 min_w_val
= ETS_E3B0_NIG_MIN_W_VAL_UP_TO_10GBPS
;
490 min_w_val
= ETS_E3B0_NIG_MIN_W_VAL_20GBPS
;
491 /* If the link isn't up (static configuration for example ) The
492 * link will be according to 20GBPS.
496 /******************************************************************************
498 * Getting credit upper bound form min_w_val.
500 ******************************************************************************/
501 static u32
bnx2x_ets_get_credit_upper_bound(const u32 min_w_val
)
503 const u32 credit_upper_bound
= (u32
)MAXVAL((150 * min_w_val
),
505 return credit_upper_bound
;
507 /******************************************************************************
509 * Set credit upper bound for NIG.
511 ******************************************************************************/
512 static void bnx2x_ets_e3b0_set_credit_upper_bound_nig(
513 const struct link_params
*params
,
516 struct bnx2x
*bp
= params
->bp
;
517 const u8 port
= params
->port
;
518 const u32 credit_upper_bound
=
519 bnx2x_ets_get_credit_upper_bound(min_w_val
);
521 REG_WR(bp
, (port
) ? NIG_REG_P1_TX_ARB_CREDIT_UPPER_BOUND_0
:
522 NIG_REG_P0_TX_ARB_CREDIT_UPPER_BOUND_0
, credit_upper_bound
);
523 REG_WR(bp
, (port
) ? NIG_REG_P1_TX_ARB_CREDIT_UPPER_BOUND_1
:
524 NIG_REG_P0_TX_ARB_CREDIT_UPPER_BOUND_1
, credit_upper_bound
);
525 REG_WR(bp
, (port
) ? NIG_REG_P1_TX_ARB_CREDIT_UPPER_BOUND_2
:
526 NIG_REG_P0_TX_ARB_CREDIT_UPPER_BOUND_2
, credit_upper_bound
);
527 REG_WR(bp
, (port
) ? NIG_REG_P1_TX_ARB_CREDIT_UPPER_BOUND_3
:
528 NIG_REG_P0_TX_ARB_CREDIT_UPPER_BOUND_3
, credit_upper_bound
);
529 REG_WR(bp
, (port
) ? NIG_REG_P1_TX_ARB_CREDIT_UPPER_BOUND_4
:
530 NIG_REG_P0_TX_ARB_CREDIT_UPPER_BOUND_4
, credit_upper_bound
);
531 REG_WR(bp
, (port
) ? NIG_REG_P1_TX_ARB_CREDIT_UPPER_BOUND_5
:
532 NIG_REG_P0_TX_ARB_CREDIT_UPPER_BOUND_5
, credit_upper_bound
);
535 REG_WR(bp
, NIG_REG_P0_TX_ARB_CREDIT_UPPER_BOUND_6
,
537 REG_WR(bp
, NIG_REG_P0_TX_ARB_CREDIT_UPPER_BOUND_7
,
539 REG_WR(bp
, NIG_REG_P0_TX_ARB_CREDIT_UPPER_BOUND_8
,
543 /******************************************************************************
545 * Will return the NIG ETS registers to init values.Except
546 * credit_upper_bound.
547 * That isn't used in this configuration (No WFQ is enabled) and will be
548 * configured acording to spec
550 ******************************************************************************/
551 static void bnx2x_ets_e3b0_nig_disabled(const struct link_params
*params
,
552 const struct link_vars
*vars
)
554 struct bnx2x
*bp
= params
->bp
;
555 const u8 port
= params
->port
;
556 const u32 min_w_val
= bnx2x_ets_get_min_w_val_nig(vars
);
557 /* Mapping between entry priority to client number (0,1,2 -debug and
558 * management clients, 3 - COS0 client, 4 - COS1, ... 8 -
559 * COS5)(HIGHEST) 4bits client num.TODO_ETS - Should be done by
560 * reset value or init tool
563 REG_WR(bp
, NIG_REG_P1_TX_ARB_PRIORITY_CLIENT2_LSB
, 0x543210);
564 REG_WR(bp
, NIG_REG_P1_TX_ARB_PRIORITY_CLIENT2_MSB
, 0x0);
566 REG_WR(bp
, NIG_REG_P0_TX_ARB_PRIORITY_CLIENT2_LSB
, 0x76543210);
567 REG_WR(bp
, NIG_REG_P0_TX_ARB_PRIORITY_CLIENT2_MSB
, 0x8);
569 /* For strict priority entries defines the number of consecutive
570 * slots for the highest priority.
572 REG_WR(bp
, (port
) ? NIG_REG_P1_TX_ARB_NUM_STRICT_ARB_SLOTS
:
573 NIG_REG_P1_TX_ARB_NUM_STRICT_ARB_SLOTS
, 0x100);
574 /* Mapping between the CREDIT_WEIGHT registers and actual client
579 REG_WR(bp
, NIG_REG_P1_TX_ARB_CLIENT_CREDIT_MAP2_LSB
, 0x210543);
580 REG_WR(bp
, NIG_REG_P1_TX_ARB_CLIENT_CREDIT_MAP2_MSB
, 0x0);
583 REG_WR(bp
, NIG_REG_P0_TX_ARB_CLIENT_CREDIT_MAP2_LSB
,
585 REG_WR(bp
, NIG_REG_P0_TX_ARB_CLIENT_CREDIT_MAP2_MSB
, 0x5);
588 /* Bitmap of 5bits length. Each bit specifies whether the entry behaves
589 * as strict. Bits 0,1,2 - debug and management entries, 3 -
590 * COS0 entry, 4 - COS1 entry.
591 * COS1 | COS0 | DEBUG1 | DEBUG0 | MGMT
592 * bit4 bit3 bit2 bit1 bit0
593 * MCP and debug are strict
596 REG_WR(bp
, NIG_REG_P1_TX_ARB_CLIENT_IS_STRICT
, 0x3f);
598 REG_WR(bp
, NIG_REG_P0_TX_ARB_CLIENT_IS_STRICT
, 0x1ff);
599 /* defines which entries (clients) are subjected to WFQ arbitration */
600 REG_WR(bp
, (port
) ? NIG_REG_P1_TX_ARB_CLIENT_IS_SUBJECT2WFQ
:
601 NIG_REG_P0_TX_ARB_CLIENT_IS_SUBJECT2WFQ
, 0);
603 /* Please notice the register address are note continuous and a
604 * for here is note appropriate.In 2 port mode port0 only COS0-5
605 * can be used. DEBUG1,DEBUG1,MGMT are never used for WFQ* In 4
606 * port mode port1 only COS0-2 can be used. DEBUG1,DEBUG1,MGMT
607 * are never used for WFQ
609 REG_WR(bp
, (port
) ? NIG_REG_P1_TX_ARB_CREDIT_WEIGHT_0
:
610 NIG_REG_P0_TX_ARB_CREDIT_WEIGHT_0
, 0x0);
611 REG_WR(bp
, (port
) ? NIG_REG_P1_TX_ARB_CREDIT_WEIGHT_1
:
612 NIG_REG_P0_TX_ARB_CREDIT_WEIGHT_1
, 0x0);
613 REG_WR(bp
, (port
) ? NIG_REG_P1_TX_ARB_CREDIT_WEIGHT_2
:
614 NIG_REG_P0_TX_ARB_CREDIT_WEIGHT_2
, 0x0);
615 REG_WR(bp
, (port
) ? NIG_REG_P1_TX_ARB_CREDIT_WEIGHT_3
:
616 NIG_REG_P0_TX_ARB_CREDIT_WEIGHT_3
, 0x0);
617 REG_WR(bp
, (port
) ? NIG_REG_P1_TX_ARB_CREDIT_WEIGHT_4
:
618 NIG_REG_P0_TX_ARB_CREDIT_WEIGHT_4
, 0x0);
619 REG_WR(bp
, (port
) ? NIG_REG_P1_TX_ARB_CREDIT_WEIGHT_5
:
620 NIG_REG_P0_TX_ARB_CREDIT_WEIGHT_5
, 0x0);
622 REG_WR(bp
, NIG_REG_P0_TX_ARB_CREDIT_WEIGHT_6
, 0x0);
623 REG_WR(bp
, NIG_REG_P0_TX_ARB_CREDIT_WEIGHT_7
, 0x0);
624 REG_WR(bp
, NIG_REG_P0_TX_ARB_CREDIT_WEIGHT_8
, 0x0);
627 bnx2x_ets_e3b0_set_credit_upper_bound_nig(params
, min_w_val
);
629 /******************************************************************************
631 * Set credit upper bound for PBF.
633 ******************************************************************************/
634 static void bnx2x_ets_e3b0_set_credit_upper_bound_pbf(
635 const struct link_params
*params
,
638 struct bnx2x
*bp
= params
->bp
;
639 const u32 credit_upper_bound
=
640 bnx2x_ets_get_credit_upper_bound(min_w_val
);
641 const u8 port
= params
->port
;
642 u32 base_upper_bound
= 0;
645 /* In 2 port mode port0 has COS0-5 that can be used for WFQ.In 4
646 * port mode port1 has COS0-2 that can be used for WFQ.
649 base_upper_bound
= PBF_REG_COS0_UPPER_BOUND_P0
;
650 max_cos
= DCBX_E3B0_MAX_NUM_COS_PORT0
;
652 base_upper_bound
= PBF_REG_COS0_UPPER_BOUND_P1
;
653 max_cos
= DCBX_E3B0_MAX_NUM_COS_PORT1
;
656 for (i
= 0; i
< max_cos
; i
++)
657 REG_WR(bp
, base_upper_bound
+ (i
<< 2), credit_upper_bound
);
660 /******************************************************************************
662 * Will return the PBF ETS registers to init values.Except
663 * credit_upper_bound.
664 * That isn't used in this configuration (No WFQ is enabled) and will be
665 * configured acording to spec
667 ******************************************************************************/
668 static void bnx2x_ets_e3b0_pbf_disabled(const struct link_params
*params
)
670 struct bnx2x
*bp
= params
->bp
;
671 const u8 port
= params
->port
;
672 const u32 min_w_val_pbf
= ETS_E3B0_PBF_MIN_W_VAL
;
677 /* Mapping between entry priority to client number 0 - COS0
678 * client, 2 - COS1, ... 5 - COS5)(HIGHEST) 4bits client num.
679 * TODO_ETS - Should be done by reset value or init tool
682 /* 0x688 (|011|0 10|00 1|000) */
683 REG_WR(bp
, PBF_REG_ETS_ARB_PRIORITY_CLIENT_P1
, 0x688);
685 /* (10 1|100 |011|0 10|00 1|000) */
686 REG_WR(bp
, PBF_REG_ETS_ARB_PRIORITY_CLIENT_P0
, 0x2C688);
688 /* TODO_ETS - Should be done by reset value or init tool */
690 /* 0x688 (|011|0 10|00 1|000)*/
691 REG_WR(bp
, PBF_REG_ETS_ARB_CLIENT_CREDIT_MAP_P1
, 0x688);
693 /* 0x2C688 (10 1|100 |011|0 10|00 1|000) */
694 REG_WR(bp
, PBF_REG_ETS_ARB_CLIENT_CREDIT_MAP_P0
, 0x2C688);
696 REG_WR(bp
, (port
) ? PBF_REG_ETS_ARB_NUM_STRICT_ARB_SLOTS_P1
:
697 PBF_REG_ETS_ARB_NUM_STRICT_ARB_SLOTS_P0
, 0x100);
700 REG_WR(bp
, (port
) ? PBF_REG_ETS_ARB_CLIENT_IS_STRICT_P1
:
701 PBF_REG_ETS_ARB_CLIENT_IS_STRICT_P0
, 0);
703 REG_WR(bp
, (port
) ? PBF_REG_ETS_ARB_CLIENT_IS_SUBJECT2WFQ_P1
:
704 PBF_REG_ETS_ARB_CLIENT_IS_SUBJECT2WFQ_P0
, 0);
705 /* In 2 port mode port0 has COS0-5 that can be used for WFQ.
706 * In 4 port mode port1 has COS0-2 that can be used for WFQ.
709 base_weight
= PBF_REG_COS0_WEIGHT_P0
;
710 max_cos
= DCBX_E3B0_MAX_NUM_COS_PORT0
;
712 base_weight
= PBF_REG_COS0_WEIGHT_P1
;
713 max_cos
= DCBX_E3B0_MAX_NUM_COS_PORT1
;
716 for (i
= 0; i
< max_cos
; i
++)
717 REG_WR(bp
, base_weight
+ (0x4 * i
), 0);
719 bnx2x_ets_e3b0_set_credit_upper_bound_pbf(params
, min_w_val_pbf
);
721 /******************************************************************************
723 * E3B0 disable will return basicly the values to init values.
725 ******************************************************************************/
726 static int bnx2x_ets_e3b0_disabled(const struct link_params
*params
,
727 const struct link_vars
*vars
)
729 struct bnx2x
*bp
= params
->bp
;
731 if (!CHIP_IS_E3B0(bp
)) {
733 "bnx2x_ets_e3b0_disabled the chip isn't E3B0\n");
737 bnx2x_ets_e3b0_nig_disabled(params
, vars
);
739 bnx2x_ets_e3b0_pbf_disabled(params
);
744 /******************************************************************************
746 * Disable will return basicly the values to init values.
748 ******************************************************************************/
749 int bnx2x_ets_disabled(struct link_params
*params
,
750 struct link_vars
*vars
)
752 struct bnx2x
*bp
= params
->bp
;
753 int bnx2x_status
= 0;
755 if ((CHIP_IS_E2(bp
)) || (CHIP_IS_E3A0(bp
)))
756 bnx2x_ets_e2e3a0_disabled(params
);
757 else if (CHIP_IS_E3B0(bp
))
758 bnx2x_status
= bnx2x_ets_e3b0_disabled(params
, vars
);
760 DP(NETIF_MSG_LINK
, "bnx2x_ets_disabled - chip not supported\n");
767 /******************************************************************************
769 * Set the COS mappimg to SP and BW until this point all the COS are not
771 ******************************************************************************/
772 static int bnx2x_ets_e3b0_cli_map(const struct link_params
*params
,
773 const struct bnx2x_ets_params
*ets_params
,
774 const u8 cos_sp_bitmap
,
775 const u8 cos_bw_bitmap
)
777 struct bnx2x
*bp
= params
->bp
;
778 const u8 port
= params
->port
;
779 const u8 nig_cli_sp_bitmap
= 0x7 | (cos_sp_bitmap
<< 3);
780 const u8 pbf_cli_sp_bitmap
= cos_sp_bitmap
;
781 const u8 nig_cli_subject2wfq_bitmap
= cos_bw_bitmap
<< 3;
782 const u8 pbf_cli_subject2wfq_bitmap
= cos_bw_bitmap
;
784 REG_WR(bp
, (port
) ? NIG_REG_P1_TX_ARB_CLIENT_IS_STRICT
:
785 NIG_REG_P0_TX_ARB_CLIENT_IS_STRICT
, nig_cli_sp_bitmap
);
787 REG_WR(bp
, (port
) ? PBF_REG_ETS_ARB_CLIENT_IS_STRICT_P1
:
788 PBF_REG_ETS_ARB_CLIENT_IS_STRICT_P0
, pbf_cli_sp_bitmap
);
790 REG_WR(bp
, (port
) ? NIG_REG_P1_TX_ARB_CLIENT_IS_SUBJECT2WFQ
:
791 NIG_REG_P0_TX_ARB_CLIENT_IS_SUBJECT2WFQ
,
792 nig_cli_subject2wfq_bitmap
);
794 REG_WR(bp
, (port
) ? PBF_REG_ETS_ARB_CLIENT_IS_SUBJECT2WFQ_P1
:
795 PBF_REG_ETS_ARB_CLIENT_IS_SUBJECT2WFQ_P0
,
796 pbf_cli_subject2wfq_bitmap
);
801 /******************************************************************************
803 * This function is needed because NIG ARB_CREDIT_WEIGHT_X are
804 * not continues and ARB_CREDIT_WEIGHT_0 + offset is suitable.
805 ******************************************************************************/
806 static int bnx2x_ets_e3b0_set_cos_bw(struct bnx2x
*bp
,
808 const u32 min_w_val_nig
,
809 const u32 min_w_val_pbf
,
814 u32 nig_reg_adress_crd_weight
= 0;
815 u32 pbf_reg_adress_crd_weight
= 0;
816 /* Calculate and set BW for this COS - use 1 instead of 0 for BW */
817 const u32 cos_bw_nig
= ((bw
? bw
: 1) * min_w_val_nig
) / total_bw
;
818 const u32 cos_bw_pbf
= ((bw
? bw
: 1) * min_w_val_pbf
) / total_bw
;
822 nig_reg_adress_crd_weight
=
823 (port
) ? NIG_REG_P1_TX_ARB_CREDIT_WEIGHT_0
:
824 NIG_REG_P0_TX_ARB_CREDIT_WEIGHT_0
;
825 pbf_reg_adress_crd_weight
= (port
) ?
826 PBF_REG_COS0_WEIGHT_P1
: PBF_REG_COS0_WEIGHT_P0
;
829 nig_reg_adress_crd_weight
= (port
) ?
830 NIG_REG_P1_TX_ARB_CREDIT_WEIGHT_1
:
831 NIG_REG_P0_TX_ARB_CREDIT_WEIGHT_1
;
832 pbf_reg_adress_crd_weight
= (port
) ?
833 PBF_REG_COS1_WEIGHT_P1
: PBF_REG_COS1_WEIGHT_P0
;
836 nig_reg_adress_crd_weight
= (port
) ?
837 NIG_REG_P1_TX_ARB_CREDIT_WEIGHT_2
:
838 NIG_REG_P0_TX_ARB_CREDIT_WEIGHT_2
;
840 pbf_reg_adress_crd_weight
= (port
) ?
841 PBF_REG_COS2_WEIGHT_P1
: PBF_REG_COS2_WEIGHT_P0
;
846 nig_reg_adress_crd_weight
=
847 NIG_REG_P0_TX_ARB_CREDIT_WEIGHT_3
;
848 pbf_reg_adress_crd_weight
=
849 PBF_REG_COS3_WEIGHT_P0
;
854 nig_reg_adress_crd_weight
=
855 NIG_REG_P0_TX_ARB_CREDIT_WEIGHT_4
;
856 pbf_reg_adress_crd_weight
= PBF_REG_COS4_WEIGHT_P0
;
861 nig_reg_adress_crd_weight
=
862 NIG_REG_P0_TX_ARB_CREDIT_WEIGHT_5
;
863 pbf_reg_adress_crd_weight
= PBF_REG_COS5_WEIGHT_P0
;
867 REG_WR(bp
, nig_reg_adress_crd_weight
, cos_bw_nig
);
869 REG_WR(bp
, pbf_reg_adress_crd_weight
, cos_bw_pbf
);
873 /******************************************************************************
875 * Calculate the total BW.A value of 0 isn't legal.
877 ******************************************************************************/
878 static int bnx2x_ets_e3b0_get_total_bw(
879 const struct link_params
*params
,
880 struct bnx2x_ets_params
*ets_params
,
883 struct bnx2x
*bp
= params
->bp
;
885 u8 is_bw_cos_exist
= 0;
888 /* Calculate total BW requested */
889 for (cos_idx
= 0; cos_idx
< ets_params
->num_of_cos
; cos_idx
++) {
890 if (ets_params
->cos
[cos_idx
].state
== bnx2x_cos_state_bw
) {
892 if (!ets_params
->cos
[cos_idx
].params
.bw_params
.bw
) {
893 DP(NETIF_MSG_LINK
, "bnx2x_ets_E3B0_config BW"
895 /* This is to prevent a state when ramrods
898 ets_params
->cos
[cos_idx
].params
.bw_params
.bw
902 ets_params
->cos
[cos_idx
].params
.bw_params
.bw
;
906 /* Check total BW is valid */
907 if ((is_bw_cos_exist
== 1) && (*total_bw
!= 100)) {
908 if (*total_bw
== 0) {
910 "bnx2x_ets_E3B0_config total BW shouldn't be 0\n");
914 "bnx2x_ets_E3B0_config total BW should be 100\n");
915 /* We can handle a case whre the BW isn't 100 this can happen
916 * if the TC are joined.
922 /******************************************************************************
924 * Invalidate all the sp_pri_to_cos.
926 ******************************************************************************/
927 static void bnx2x_ets_e3b0_sp_pri_to_cos_init(u8
*sp_pri_to_cos
)
930 for (pri
= 0; pri
< DCBX_MAX_NUM_COS
; pri
++)
931 sp_pri_to_cos
[pri
] = DCBX_INVALID_COS
;
933 /******************************************************************************
935 * Calculate and set the SP (ARB_PRIORITY_CLIENT) NIG and PBF registers
936 * according to sp_pri_to_cos.
938 ******************************************************************************/
939 static int bnx2x_ets_e3b0_sp_pri_to_cos_set(const struct link_params
*params
,
940 u8
*sp_pri_to_cos
, const u8 pri
,
943 struct bnx2x
*bp
= params
->bp
;
944 const u8 port
= params
->port
;
945 const u8 max_num_of_cos
= (port
) ? DCBX_E3B0_MAX_NUM_COS_PORT1
:
946 DCBX_E3B0_MAX_NUM_COS_PORT0
;
948 if (pri
>= max_num_of_cos
) {
949 DP(NETIF_MSG_LINK
, "bnx2x_ets_e3b0_sp_pri_to_cos_set invalid "
950 "parameter Illegal strict priority\n");
954 if (sp_pri_to_cos
[pri
] != DCBX_INVALID_COS
) {
955 DP(NETIF_MSG_LINK
, "bnx2x_ets_e3b0_sp_pri_to_cos_set invalid "
956 "parameter There can't be two COS's with "
957 "the same strict pri\n");
961 sp_pri_to_cos
[pri
] = cos_entry
;
966 /******************************************************************************
968 * Returns the correct value according to COS and priority in
969 * the sp_pri_cli register.
971 ******************************************************************************/
972 static u64
bnx2x_e3b0_sp_get_pri_cli_reg(const u8 cos
, const u8 cos_offset
,
978 pri_cli_nig
= ((u64
)(cos
+ cos_offset
)) << (entry_size
*
979 (pri_set
+ pri_offset
));
983 /******************************************************************************
985 * Returns the correct value according to COS and priority in the
986 * sp_pri_cli register for NIG.
988 ******************************************************************************/
989 static u64
bnx2x_e3b0_sp_get_pri_cli_reg_nig(const u8 cos
, const u8 pri_set
)
991 /* MCP Dbg0 and dbg1 are always with higher strict pri*/
992 const u8 nig_cos_offset
= 3;
993 const u8 nig_pri_offset
= 3;
995 return bnx2x_e3b0_sp_get_pri_cli_reg(cos
, nig_cos_offset
, pri_set
,
999 /******************************************************************************
1001 * Returns the correct value according to COS and priority in the
1002 * sp_pri_cli register for PBF.
1004 ******************************************************************************/
1005 static u64
bnx2x_e3b0_sp_get_pri_cli_reg_pbf(const u8 cos
, const u8 pri_set
)
1007 const u8 pbf_cos_offset
= 0;
1008 const u8 pbf_pri_offset
= 0;
1010 return bnx2x_e3b0_sp_get_pri_cli_reg(cos
, pbf_cos_offset
, pri_set
,
1015 /******************************************************************************
1017 * Calculate and set the SP (ARB_PRIORITY_CLIENT) NIG and PBF registers
1018 * according to sp_pri_to_cos.(which COS has higher priority)
1020 ******************************************************************************/
1021 static int bnx2x_ets_e3b0_sp_set_pri_cli_reg(const struct link_params
*params
,
1024 struct bnx2x
*bp
= params
->bp
;
1026 const u8 port
= params
->port
;
1027 /* MCP Dbg0 and dbg1 are always with higher strict pri*/
1028 u64 pri_cli_nig
= 0x210;
1029 u32 pri_cli_pbf
= 0x0;
1032 const u8 max_num_of_cos
= (port
) ? DCBX_E3B0_MAX_NUM_COS_PORT1
:
1033 DCBX_E3B0_MAX_NUM_COS_PORT0
;
1035 u8 cos_bit_to_set
= (1 << max_num_of_cos
) - 1;
1037 /* Set all the strict priority first */
1038 for (i
= 0; i
< max_num_of_cos
; i
++) {
1039 if (sp_pri_to_cos
[i
] != DCBX_INVALID_COS
) {
1040 if (sp_pri_to_cos
[i
] >= DCBX_MAX_NUM_COS
) {
1042 "bnx2x_ets_e3b0_sp_set_pri_cli_reg "
1043 "invalid cos entry\n");
1047 pri_cli_nig
|= bnx2x_e3b0_sp_get_pri_cli_reg_nig(
1048 sp_pri_to_cos
[i
], pri_set
);
1050 pri_cli_pbf
|= bnx2x_e3b0_sp_get_pri_cli_reg_pbf(
1051 sp_pri_to_cos
[i
], pri_set
);
1052 pri_bitmask
= 1 << sp_pri_to_cos
[i
];
1053 /* COS is used remove it from bitmap.*/
1054 if (!(pri_bitmask
& cos_bit_to_set
)) {
1056 "bnx2x_ets_e3b0_sp_set_pri_cli_reg "
1057 "invalid There can't be two COS's with"
1058 " the same strict pri\n");
1061 cos_bit_to_set
&= ~pri_bitmask
;
1066 /* Set all the Non strict priority i= COS*/
1067 for (i
= 0; i
< max_num_of_cos
; i
++) {
1068 pri_bitmask
= 1 << i
;
1069 /* Check if COS was already used for SP */
1070 if (pri_bitmask
& cos_bit_to_set
) {
1071 /* COS wasn't used for SP */
1072 pri_cli_nig
|= bnx2x_e3b0_sp_get_pri_cli_reg_nig(
1075 pri_cli_pbf
|= bnx2x_e3b0_sp_get_pri_cli_reg_pbf(
1077 /* COS is used remove it from bitmap.*/
1078 cos_bit_to_set
&= ~pri_bitmask
;
1083 if (pri_set
!= max_num_of_cos
) {
1084 DP(NETIF_MSG_LINK
, "bnx2x_ets_e3b0_sp_set_pri_cli_reg not all "
1085 "entries were set\n");
1090 /* Only 6 usable clients*/
1091 REG_WR(bp
, NIG_REG_P1_TX_ARB_PRIORITY_CLIENT2_LSB
,
1094 REG_WR(bp
, PBF_REG_ETS_ARB_PRIORITY_CLIENT_P1
, pri_cli_pbf
);
1096 /* Only 9 usable clients*/
1097 const u32 pri_cli_nig_lsb
= (u32
) (pri_cli_nig
);
1098 const u32 pri_cli_nig_msb
= (u32
) ((pri_cli_nig
>> 32) & 0xF);
1100 REG_WR(bp
, NIG_REG_P0_TX_ARB_PRIORITY_CLIENT2_LSB
,
1102 REG_WR(bp
, NIG_REG_P0_TX_ARB_PRIORITY_CLIENT2_MSB
,
1105 REG_WR(bp
, PBF_REG_ETS_ARB_PRIORITY_CLIENT_P0
, pri_cli_pbf
);
1110 /******************************************************************************
1112 * Configure the COS to ETS according to BW and SP settings.
1113 ******************************************************************************/
1114 int bnx2x_ets_e3b0_config(const struct link_params
*params
,
1115 const struct link_vars
*vars
,
1116 struct bnx2x_ets_params
*ets_params
)
1118 struct bnx2x
*bp
= params
->bp
;
1119 int bnx2x_status
= 0;
1120 const u8 port
= params
->port
;
1122 const u32 min_w_val_nig
= bnx2x_ets_get_min_w_val_nig(vars
);
1123 const u32 min_w_val_pbf
= ETS_E3B0_PBF_MIN_W_VAL
;
1124 u8 cos_bw_bitmap
= 0;
1125 u8 cos_sp_bitmap
= 0;
1126 u8 sp_pri_to_cos
[DCBX_MAX_NUM_COS
] = {0};
1127 const u8 max_num_of_cos
= (port
) ? DCBX_E3B0_MAX_NUM_COS_PORT1
:
1128 DCBX_E3B0_MAX_NUM_COS_PORT0
;
1131 if (!CHIP_IS_E3B0(bp
)) {
1133 "bnx2x_ets_e3b0_disabled the chip isn't E3B0\n");
1137 if ((ets_params
->num_of_cos
> max_num_of_cos
)) {
1138 DP(NETIF_MSG_LINK
, "bnx2x_ets_E3B0_config the number of COS "
1139 "isn't supported\n");
1143 /* Prepare sp strict priority parameters*/
1144 bnx2x_ets_e3b0_sp_pri_to_cos_init(sp_pri_to_cos
);
1146 /* Prepare BW parameters*/
1147 bnx2x_status
= bnx2x_ets_e3b0_get_total_bw(params
, ets_params
,
1151 "bnx2x_ets_E3B0_config get_total_bw failed\n");
1155 /* Upper bound is set according to current link speed (min_w_val
1156 * should be the same for upper bound and COS credit val).
1158 bnx2x_ets_e3b0_set_credit_upper_bound_nig(params
, min_w_val_nig
);
1159 bnx2x_ets_e3b0_set_credit_upper_bound_pbf(params
, min_w_val_pbf
);
1162 for (cos_entry
= 0; cos_entry
< ets_params
->num_of_cos
; cos_entry
++) {
1163 if (bnx2x_cos_state_bw
== ets_params
->cos
[cos_entry
].state
) {
1164 cos_bw_bitmap
|= (1 << cos_entry
);
1165 /* The function also sets the BW in HW(not the mappin
1168 bnx2x_status
= bnx2x_ets_e3b0_set_cos_bw(
1169 bp
, cos_entry
, min_w_val_nig
, min_w_val_pbf
,
1171 ets_params
->cos
[cos_entry
].params
.bw_params
.bw
,
1173 } else if (bnx2x_cos_state_strict
==
1174 ets_params
->cos
[cos_entry
].state
){
1175 cos_sp_bitmap
|= (1 << cos_entry
);
1177 bnx2x_status
= bnx2x_ets_e3b0_sp_pri_to_cos_set(
1180 ets_params
->cos
[cos_entry
].params
.sp_params
.pri
,
1185 "bnx2x_ets_e3b0_config cos state not valid\n");
1190 "bnx2x_ets_e3b0_config set cos bw failed\n");
1191 return bnx2x_status
;
1195 /* Set SP register (which COS has higher priority) */
1196 bnx2x_status
= bnx2x_ets_e3b0_sp_set_pri_cli_reg(params
,
1201 "bnx2x_ets_E3B0_config set_pri_cli_reg failed\n");
1202 return bnx2x_status
;
1205 /* Set client mapping of BW and strict */
1206 bnx2x_status
= bnx2x_ets_e3b0_cli_map(params
, ets_params
,
1211 DP(NETIF_MSG_LINK
, "bnx2x_ets_E3B0_config SP failed\n");
1212 return bnx2x_status
;
1216 static void bnx2x_ets_bw_limit_common(const struct link_params
*params
)
1218 /* ETS disabled configuration */
1219 struct bnx2x
*bp
= params
->bp
;
1220 DP(NETIF_MSG_LINK
, "ETS enabled BW limit configuration\n");
1221 /* Defines which entries (clients) are subjected to WFQ arbitration
1225 REG_WR(bp
, NIG_REG_P0_TX_ARB_CLIENT_IS_SUBJECT2WFQ
, 0x18);
1226 /* Mapping between the ARB_CREDIT_WEIGHT registers and actual
1227 * client numbers (WEIGHT_0 does not actually have to represent
1229 * PRI4 | PRI3 | PRI2 | PRI1 | PRI0
1230 * cos1-001 cos0-000 dbg1-100 dbg0-011 MCP-010
1232 REG_WR(bp
, NIG_REG_P0_TX_ARB_CLIENT_CREDIT_MAP
, 0x111A);
1234 REG_WR(bp
, NIG_REG_P0_TX_ARB_CREDIT_UPPER_BOUND_0
,
1235 ETS_BW_LIMIT_CREDIT_UPPER_BOUND
);
1236 REG_WR(bp
, NIG_REG_P0_TX_ARB_CREDIT_UPPER_BOUND_1
,
1237 ETS_BW_LIMIT_CREDIT_UPPER_BOUND
);
1239 /* ETS mode enabled*/
1240 REG_WR(bp
, PBF_REG_ETS_ENABLED
, 1);
1242 /* Defines the number of consecutive slots for the strict priority */
1243 REG_WR(bp
, PBF_REG_NUM_STRICT_ARB_SLOTS
, 0);
1244 /* Bitmap of 5bits length. Each bit specifies whether the entry behaves
1245 * as strict. Bits 0,1,2 - debug and management entries, 3 - COS0
1246 * entry, 4 - COS1 entry.
1247 * COS1 | COS0 | DEBUG21 | DEBUG0 | MGMT
1248 * bit4 bit3 bit2 bit1 bit0
1249 * MCP and debug are strict
1251 REG_WR(bp
, NIG_REG_P0_TX_ARB_CLIENT_IS_STRICT
, 0x7);
1253 /* Upper bound that COS0_WEIGHT can reach in the WFQ arbiter.*/
1254 REG_WR(bp
, PBF_REG_COS0_UPPER_BOUND
,
1255 ETS_BW_LIMIT_CREDIT_UPPER_BOUND
);
1256 REG_WR(bp
, PBF_REG_COS1_UPPER_BOUND
,
1257 ETS_BW_LIMIT_CREDIT_UPPER_BOUND
);
1260 void bnx2x_ets_bw_limit(const struct link_params
*params
, const u32 cos0_bw
,
1263 /* ETS disabled configuration*/
1264 struct bnx2x
*bp
= params
->bp
;
1265 const u32 total_bw
= cos0_bw
+ cos1_bw
;
1266 u32 cos0_credit_weight
= 0;
1267 u32 cos1_credit_weight
= 0;
1269 DP(NETIF_MSG_LINK
, "ETS enabled BW limit configuration\n");
1274 DP(NETIF_MSG_LINK
, "Total BW can't be zero\n");
1278 cos0_credit_weight
= (cos0_bw
* ETS_BW_LIMIT_CREDIT_WEIGHT
)/
1280 cos1_credit_weight
= (cos1_bw
* ETS_BW_LIMIT_CREDIT_WEIGHT
)/
1283 bnx2x_ets_bw_limit_common(params
);
1285 REG_WR(bp
, NIG_REG_P0_TX_ARB_CREDIT_WEIGHT_0
, cos0_credit_weight
);
1286 REG_WR(bp
, NIG_REG_P0_TX_ARB_CREDIT_WEIGHT_1
, cos1_credit_weight
);
1288 REG_WR(bp
, PBF_REG_COS0_WEIGHT
, cos0_credit_weight
);
1289 REG_WR(bp
, PBF_REG_COS1_WEIGHT
, cos1_credit_weight
);
1292 int bnx2x_ets_strict(const struct link_params
*params
, const u8 strict_cos
)
1294 /* ETS disabled configuration*/
1295 struct bnx2x
*bp
= params
->bp
;
1298 DP(NETIF_MSG_LINK
, "ETS enabled strict configuration\n");
1299 /* Bitmap of 5bits length. Each bit specifies whether the entry behaves
1300 * as strict. Bits 0,1,2 - debug and management entries,
1301 * 3 - COS0 entry, 4 - COS1 entry.
1302 * COS1 | COS0 | DEBUG21 | DEBUG0 | MGMT
1303 * bit4 bit3 bit2 bit1 bit0
1304 * MCP and debug are strict
1306 REG_WR(bp
, NIG_REG_P0_TX_ARB_CLIENT_IS_STRICT
, 0x1F);
1307 /* For strict priority entries defines the number of consecutive slots
1308 * for the highest priority.
1310 REG_WR(bp
, NIG_REG_P0_TX_ARB_NUM_STRICT_ARB_SLOTS
, 0x100);
1311 /* ETS mode disable */
1312 REG_WR(bp
, PBF_REG_ETS_ENABLED
, 0);
1313 /* Defines the number of consecutive slots for the strict priority */
1314 REG_WR(bp
, PBF_REG_NUM_STRICT_ARB_SLOTS
, 0x100);
1316 /* Defines the number of consecutive slots for the strict priority */
1317 REG_WR(bp
, PBF_REG_HIGH_PRIORITY_COS_NUM
, strict_cos
);
1319 /* Mapping between entry priority to client number (0,1,2 -debug and
1320 * management clients, 3 - COS0 client, 4 - COS client)(HIGHEST)
1322 * PRI4 | PRI3 | PRI2 | PRI1 | PRI0
1323 * dbg0-010 dbg1-001 cos1-100 cos0-011 MCP-000
1324 * dbg0-010 dbg1-001 cos0-011 cos1-100 MCP-000
1326 val
= (!strict_cos
) ? 0x2318 : 0x22E0;
1327 REG_WR(bp
, NIG_REG_P0_TX_ARB_PRIORITY_CLIENT
, val
);
1332 /******************************************************************/
1334 /******************************************************************/
1335 static void bnx2x_update_pfc_xmac(struct link_params
*params
,
1336 struct link_vars
*vars
,
1339 struct bnx2x
*bp
= params
->bp
;
1341 u32 pause_val
, pfc0_val
, pfc1_val
;
1343 /* XMAC base adrr */
1344 xmac_base
= (params
->port
) ? GRCBASE_XMAC1
: GRCBASE_XMAC0
;
1346 /* Initialize pause and pfc registers */
1347 pause_val
= 0x18000;
1348 pfc0_val
= 0xFFFF8000;
1351 /* No PFC support */
1352 if (!(params
->feature_config_flags
&
1353 FEATURE_CONFIG_PFC_ENABLED
)) {
1355 /* RX flow control - Process pause frame in receive direction
1357 if (vars
->flow_ctrl
& BNX2X_FLOW_CTRL_RX
)
1358 pause_val
|= XMAC_PAUSE_CTRL_REG_RX_PAUSE_EN
;
1360 /* TX flow control - Send pause packet when buffer is full */
1361 if (vars
->flow_ctrl
& BNX2X_FLOW_CTRL_TX
)
1362 pause_val
|= XMAC_PAUSE_CTRL_REG_TX_PAUSE_EN
;
1363 } else {/* PFC support */
1364 pfc1_val
|= XMAC_PFC_CTRL_HI_REG_PFC_REFRESH_EN
|
1365 XMAC_PFC_CTRL_HI_REG_PFC_STATS_EN
|
1366 XMAC_PFC_CTRL_HI_REG_RX_PFC_EN
|
1367 XMAC_PFC_CTRL_HI_REG_TX_PFC_EN
|
1368 XMAC_PFC_CTRL_HI_REG_FORCE_PFC_XON
;
1369 /* Write pause and PFC registers */
1370 REG_WR(bp
, xmac_base
+ XMAC_REG_PAUSE_CTRL
, pause_val
);
1371 REG_WR(bp
, xmac_base
+ XMAC_REG_PFC_CTRL
, pfc0_val
);
1372 REG_WR(bp
, xmac_base
+ XMAC_REG_PFC_CTRL_HI
, pfc1_val
);
1373 pfc1_val
&= ~XMAC_PFC_CTRL_HI_REG_FORCE_PFC_XON
;
1377 /* Write pause and PFC registers */
1378 REG_WR(bp
, xmac_base
+ XMAC_REG_PAUSE_CTRL
, pause_val
);
1379 REG_WR(bp
, xmac_base
+ XMAC_REG_PFC_CTRL
, pfc0_val
);
1380 REG_WR(bp
, xmac_base
+ XMAC_REG_PFC_CTRL_HI
, pfc1_val
);
1383 /* Set MAC address for source TX Pause/PFC frames */
1384 REG_WR(bp
, xmac_base
+ XMAC_REG_CTRL_SA_LO
,
1385 ((params
->mac_addr
[2] << 24) |
1386 (params
->mac_addr
[3] << 16) |
1387 (params
->mac_addr
[4] << 8) |
1388 (params
->mac_addr
[5])));
1389 REG_WR(bp
, xmac_base
+ XMAC_REG_CTRL_SA_HI
,
1390 ((params
->mac_addr
[0] << 8) |
1391 (params
->mac_addr
[1])));
1397 static void bnx2x_emac_get_pfc_stat(struct link_params
*params
,
1398 u32 pfc_frames_sent
[2],
1399 u32 pfc_frames_received
[2])
1401 /* Read pfc statistic */
1402 struct bnx2x
*bp
= params
->bp
;
1403 u32 emac_base
= params
->port
? GRCBASE_EMAC1
: GRCBASE_EMAC0
;
1407 DP(NETIF_MSG_LINK
, "pfc statistic read from EMAC\n");
1409 /* PFC received frames */
1410 val_xoff
= REG_RD(bp
, emac_base
+
1411 EMAC_REG_RX_PFC_STATS_XOFF_RCVD
);
1412 val_xoff
&= EMAC_REG_RX_PFC_STATS_XOFF_RCVD_COUNT
;
1413 val_xon
= REG_RD(bp
, emac_base
+ EMAC_REG_RX_PFC_STATS_XON_RCVD
);
1414 val_xon
&= EMAC_REG_RX_PFC_STATS_XON_RCVD_COUNT
;
1416 pfc_frames_received
[0] = val_xon
+ val_xoff
;
1418 /* PFC received sent */
1419 val_xoff
= REG_RD(bp
, emac_base
+
1420 EMAC_REG_RX_PFC_STATS_XOFF_SENT
);
1421 val_xoff
&= EMAC_REG_RX_PFC_STATS_XOFF_SENT_COUNT
;
1422 val_xon
= REG_RD(bp
, emac_base
+ EMAC_REG_RX_PFC_STATS_XON_SENT
);
1423 val_xon
&= EMAC_REG_RX_PFC_STATS_XON_SENT_COUNT
;
1425 pfc_frames_sent
[0] = val_xon
+ val_xoff
;
1428 /* Read pfc statistic*/
1429 void bnx2x_pfc_statistic(struct link_params
*params
, struct link_vars
*vars
,
1430 u32 pfc_frames_sent
[2],
1431 u32 pfc_frames_received
[2])
1433 /* Read pfc statistic */
1434 struct bnx2x
*bp
= params
->bp
;
1436 DP(NETIF_MSG_LINK
, "pfc statistic\n");
1441 if (vars
->mac_type
== MAC_TYPE_EMAC
) {
1442 DP(NETIF_MSG_LINK
, "About to read PFC stats from EMAC\n");
1443 bnx2x_emac_get_pfc_stat(params
, pfc_frames_sent
,
1444 pfc_frames_received
);
1447 /******************************************************************/
1448 /* MAC/PBF section */
1449 /******************************************************************/
1450 static void bnx2x_set_mdio_clk(struct bnx2x
*bp
, u32 chip_id
,
1453 u32 new_mode
, cur_mode
;
1455 /* Set clause 45 mode, slow down the MDIO clock to 2.5MHz
1456 * (a value of 49==0x31) and make sure that the AUTO poll is off
1458 cur_mode
= REG_RD(bp
, emac_base
+ EMAC_REG_EMAC_MDIO_MODE
);
1460 if (USES_WARPCORE(bp
))
1461 clc_cnt
= 74L << EMAC_MDIO_MODE_CLOCK_CNT_BITSHIFT
;
1463 clc_cnt
= 49L << EMAC_MDIO_MODE_CLOCK_CNT_BITSHIFT
;
1465 if (((cur_mode
& EMAC_MDIO_MODE_CLOCK_CNT
) == clc_cnt
) &&
1466 (cur_mode
& (EMAC_MDIO_MODE_CLAUSE_45
)))
1469 new_mode
= cur_mode
&
1470 ~(EMAC_MDIO_MODE_AUTO_POLL
| EMAC_MDIO_MODE_CLOCK_CNT
);
1471 new_mode
|= clc_cnt
;
1472 new_mode
|= (EMAC_MDIO_MODE_CLAUSE_45
);
1474 DP(NETIF_MSG_LINK
, "Changing emac_mode from 0x%x to 0x%x\n",
1475 cur_mode
, new_mode
);
1476 REG_WR(bp
, emac_base
+ EMAC_REG_EMAC_MDIO_MODE
, new_mode
);
1480 static void bnx2x_set_mdio_emac_per_phy(struct bnx2x
*bp
,
1481 struct link_params
*params
)
1484 /* Set mdio clock per phy */
1485 for (phy_index
= INT_PHY
; phy_index
< params
->num_phys
;
1487 bnx2x_set_mdio_clk(bp
, params
->chip_id
,
1488 params
->phy
[phy_index
].mdio_ctrl
);
1491 static u8
bnx2x_is_4_port_mode(struct bnx2x
*bp
)
1493 u32 port4mode_ovwr_val
;
1494 /* Check 4-port override enabled */
1495 port4mode_ovwr_val
= REG_RD(bp
, MISC_REG_PORT4MODE_EN_OVWR
);
1496 if (port4mode_ovwr_val
& (1<<0)) {
1497 /* Return 4-port mode override value */
1498 return ((port4mode_ovwr_val
& (1<<1)) == (1<<1));
1500 /* Return 4-port mode from input pin */
1501 return (u8
)REG_RD(bp
, MISC_REG_PORT4MODE_EN
);
1504 static void bnx2x_emac_init(struct link_params
*params
,
1505 struct link_vars
*vars
)
1507 /* reset and unreset the emac core */
1508 struct bnx2x
*bp
= params
->bp
;
1509 u8 port
= params
->port
;
1510 u32 emac_base
= port
? GRCBASE_EMAC1
: GRCBASE_EMAC0
;
1514 REG_WR(bp
, GRCBASE_MISC
+ MISC_REGISTERS_RESET_REG_2_CLEAR
,
1515 (MISC_REGISTERS_RESET_REG_2_RST_EMAC0_HARD_CORE
<< port
));
1517 REG_WR(bp
, GRCBASE_MISC
+ MISC_REGISTERS_RESET_REG_2_SET
,
1518 (MISC_REGISTERS_RESET_REG_2_RST_EMAC0_HARD_CORE
<< port
));
1520 /* init emac - use read-modify-write */
1521 /* self clear reset */
1522 val
= REG_RD(bp
, emac_base
+ EMAC_REG_EMAC_MODE
);
1523 EMAC_WR(bp
, EMAC_REG_EMAC_MODE
, (val
| EMAC_MODE_RESET
));
1527 val
= REG_RD(bp
, emac_base
+ EMAC_REG_EMAC_MODE
);
1528 DP(NETIF_MSG_LINK
, "EMAC reset reg is %u\n", val
);
1530 DP(NETIF_MSG_LINK
, "EMAC timeout!\n");
1534 } while (val
& EMAC_MODE_RESET
);
1536 bnx2x_set_mdio_emac_per_phy(bp
, params
);
1537 /* Set mac address */
1538 val
= ((params
->mac_addr
[0] << 8) |
1539 params
->mac_addr
[1]);
1540 EMAC_WR(bp
, EMAC_REG_EMAC_MAC_MATCH
, val
);
1542 val
= ((params
->mac_addr
[2] << 24) |
1543 (params
->mac_addr
[3] << 16) |
1544 (params
->mac_addr
[4] << 8) |
1545 params
->mac_addr
[5]);
1546 EMAC_WR(bp
, EMAC_REG_EMAC_MAC_MATCH
+ 4, val
);
1549 static void bnx2x_set_xumac_nig(struct link_params
*params
,
1553 struct bnx2x
*bp
= params
->bp
;
1555 REG_WR(bp
, params
->port
? NIG_REG_P1_MAC_IN_EN
: NIG_REG_P0_MAC_IN_EN
,
1557 REG_WR(bp
, params
->port
? NIG_REG_P1_MAC_OUT_EN
: NIG_REG_P0_MAC_OUT_EN
,
1559 REG_WR(bp
, params
->port
? NIG_REG_P1_MAC_PAUSE_OUT_EN
:
1560 NIG_REG_P0_MAC_PAUSE_OUT_EN
, tx_pause_en
);
1563 static void bnx2x_set_umac_rxtx(struct link_params
*params
, u8 en
)
1565 u32 umac_base
= params
->port
? GRCBASE_UMAC1
: GRCBASE_UMAC0
;
1567 struct bnx2x
*bp
= params
->bp
;
1568 if (!(REG_RD(bp
, MISC_REG_RESET_REG_2
) &
1569 (MISC_REGISTERS_RESET_REG_2_UMAC0
<< params
->port
)))
1571 val
= REG_RD(bp
, umac_base
+ UMAC_REG_COMMAND_CONFIG
);
1573 val
|= (UMAC_COMMAND_CONFIG_REG_TX_ENA
|
1574 UMAC_COMMAND_CONFIG_REG_RX_ENA
);
1576 val
&= ~(UMAC_COMMAND_CONFIG_REG_TX_ENA
|
1577 UMAC_COMMAND_CONFIG_REG_RX_ENA
);
1578 /* Disable RX and TX */
1579 REG_WR(bp
, umac_base
+ UMAC_REG_COMMAND_CONFIG
, val
);
1582 static void bnx2x_umac_enable(struct link_params
*params
,
1583 struct link_vars
*vars
, u8 lb
)
1586 u32 umac_base
= params
->port
? GRCBASE_UMAC1
: GRCBASE_UMAC0
;
1587 struct bnx2x
*bp
= params
->bp
;
1589 REG_WR(bp
, GRCBASE_MISC
+ MISC_REGISTERS_RESET_REG_2_CLEAR
,
1590 (MISC_REGISTERS_RESET_REG_2_UMAC0
<< params
->port
));
1591 usleep_range(1000, 2000);
1593 REG_WR(bp
, GRCBASE_MISC
+ MISC_REGISTERS_RESET_REG_2_SET
,
1594 (MISC_REGISTERS_RESET_REG_2_UMAC0
<< params
->port
));
1596 DP(NETIF_MSG_LINK
, "enabling UMAC\n");
1598 /* This register opens the gate for the UMAC despite its name */
1599 REG_WR(bp
, NIG_REG_EGRESS_EMAC0_PORT
+ params
->port
*4, 1);
1601 val
= UMAC_COMMAND_CONFIG_REG_PROMIS_EN
|
1602 UMAC_COMMAND_CONFIG_REG_PAD_EN
|
1603 UMAC_COMMAND_CONFIG_REG_SW_RESET
|
1604 UMAC_COMMAND_CONFIG_REG_NO_LGTH_CHECK
;
1605 switch (vars
->line_speed
) {
1619 DP(NETIF_MSG_LINK
, "Invalid speed for UMAC %d\n",
1623 if (!(vars
->flow_ctrl
& BNX2X_FLOW_CTRL_TX
))
1624 val
|= UMAC_COMMAND_CONFIG_REG_IGNORE_TX_PAUSE
;
1626 if (!(vars
->flow_ctrl
& BNX2X_FLOW_CTRL_RX
))
1627 val
|= UMAC_COMMAND_CONFIG_REG_PAUSE_IGNORE
;
1629 if (vars
->duplex
== DUPLEX_HALF
)
1630 val
|= UMAC_COMMAND_CONFIG_REG_HD_ENA
;
1632 REG_WR(bp
, umac_base
+ UMAC_REG_COMMAND_CONFIG
, val
);
1635 /* Configure UMAC for EEE */
1636 if (vars
->eee_status
& SHMEM_EEE_ADV_STATUS_MASK
) {
1637 DP(NETIF_MSG_LINK
, "configured UMAC for EEE\n");
1638 REG_WR(bp
, umac_base
+ UMAC_REG_UMAC_EEE_CTRL
,
1639 UMAC_UMAC_EEE_CTRL_REG_EEE_EN
);
1640 REG_WR(bp
, umac_base
+ UMAC_REG_EEE_WAKE_TIMER
, 0x11);
1642 REG_WR(bp
, umac_base
+ UMAC_REG_UMAC_EEE_CTRL
, 0x0);
1645 /* Set MAC address for source TX Pause/PFC frames (under SW reset) */
1646 REG_WR(bp
, umac_base
+ UMAC_REG_MAC_ADDR0
,
1647 ((params
->mac_addr
[2] << 24) |
1648 (params
->mac_addr
[3] << 16) |
1649 (params
->mac_addr
[4] << 8) |
1650 (params
->mac_addr
[5])));
1651 REG_WR(bp
, umac_base
+ UMAC_REG_MAC_ADDR1
,
1652 ((params
->mac_addr
[0] << 8) |
1653 (params
->mac_addr
[1])));
1655 /* Enable RX and TX */
1656 val
&= ~UMAC_COMMAND_CONFIG_REG_PAD_EN
;
1657 val
|= UMAC_COMMAND_CONFIG_REG_TX_ENA
|
1658 UMAC_COMMAND_CONFIG_REG_RX_ENA
;
1659 REG_WR(bp
, umac_base
+ UMAC_REG_COMMAND_CONFIG
, val
);
1662 /* Remove SW Reset */
1663 val
&= ~UMAC_COMMAND_CONFIG_REG_SW_RESET
;
1665 /* Check loopback mode */
1667 val
|= UMAC_COMMAND_CONFIG_REG_LOOP_ENA
;
1668 REG_WR(bp
, umac_base
+ UMAC_REG_COMMAND_CONFIG
, val
);
1670 /* Maximum Frame Length (RW). Defines a 14-Bit maximum frame
1671 * length used by the MAC receive logic to check frames.
1673 REG_WR(bp
, umac_base
+ UMAC_REG_MAXFR
, 0x2710);
1674 bnx2x_set_xumac_nig(params
,
1675 ((vars
->flow_ctrl
& BNX2X_FLOW_CTRL_TX
) != 0), 1);
1676 vars
->mac_type
= MAC_TYPE_UMAC
;
1680 /* Define the XMAC mode */
1681 static void bnx2x_xmac_init(struct link_params
*params
, u32 max_speed
)
1683 struct bnx2x
*bp
= params
->bp
;
1684 u32 is_port4mode
= bnx2x_is_4_port_mode(bp
);
1686 /* In 4-port mode, need to set the mode only once, so if XMAC is
1687 * already out of reset, it means the mode has already been set,
1688 * and it must not* reset the XMAC again, since it controls both
1692 if (((CHIP_NUM(bp
) == CHIP_NUM_57840_4_10
) ||
1693 (CHIP_NUM(bp
) == CHIP_NUM_57840_2_20
) ||
1694 (CHIP_NUM(bp
) == CHIP_NUM_57840_OBSOLETE
)) &&
1696 (REG_RD(bp
, MISC_REG_RESET_REG_2
) &
1697 MISC_REGISTERS_RESET_REG_2_XMAC
)) {
1699 "XMAC already out of reset in 4-port mode\n");
1704 REG_WR(bp
, GRCBASE_MISC
+ MISC_REGISTERS_RESET_REG_2_CLEAR
,
1705 MISC_REGISTERS_RESET_REG_2_XMAC
);
1706 usleep_range(1000, 2000);
1708 REG_WR(bp
, GRCBASE_MISC
+ MISC_REGISTERS_RESET_REG_2_SET
,
1709 MISC_REGISTERS_RESET_REG_2_XMAC
);
1711 DP(NETIF_MSG_LINK
, "Init XMAC to 2 ports x 10G per path\n");
1713 /* Set the number of ports on the system side to up to 2 */
1714 REG_WR(bp
, MISC_REG_XMAC_CORE_PORT_MODE
, 1);
1716 /* Set the number of ports on the Warp Core to 10G */
1717 REG_WR(bp
, MISC_REG_XMAC_PHY_PORT_MODE
, 3);
1719 /* Set the number of ports on the system side to 1 */
1720 REG_WR(bp
, MISC_REG_XMAC_CORE_PORT_MODE
, 0);
1721 if (max_speed
== SPEED_10000
) {
1723 "Init XMAC to 10G x 1 port per path\n");
1724 /* Set the number of ports on the Warp Core to 10G */
1725 REG_WR(bp
, MISC_REG_XMAC_PHY_PORT_MODE
, 3);
1728 "Init XMAC to 20G x 2 ports per path\n");
1729 /* Set the number of ports on the Warp Core to 20G */
1730 REG_WR(bp
, MISC_REG_XMAC_PHY_PORT_MODE
, 1);
1734 REG_WR(bp
, GRCBASE_MISC
+ MISC_REGISTERS_RESET_REG_2_CLEAR
,
1735 MISC_REGISTERS_RESET_REG_2_XMAC_SOFT
);
1736 usleep_range(1000, 2000);
1738 REG_WR(bp
, GRCBASE_MISC
+ MISC_REGISTERS_RESET_REG_2_SET
,
1739 MISC_REGISTERS_RESET_REG_2_XMAC_SOFT
);
1743 static void bnx2x_set_xmac_rxtx(struct link_params
*params
, u8 en
)
1745 u8 port
= params
->port
;
1746 struct bnx2x
*bp
= params
->bp
;
1747 u32 pfc_ctrl
, xmac_base
= (port
) ? GRCBASE_XMAC1
: GRCBASE_XMAC0
;
1750 if (REG_RD(bp
, MISC_REG_RESET_REG_2
) &
1751 MISC_REGISTERS_RESET_REG_2_XMAC
) {
1752 /* Send an indication to change the state in the NIG back to XON
1753 * Clearing this bit enables the next set of this bit to get
1756 pfc_ctrl
= REG_RD(bp
, xmac_base
+ XMAC_REG_PFC_CTRL_HI
);
1757 REG_WR(bp
, xmac_base
+ XMAC_REG_PFC_CTRL_HI
,
1758 (pfc_ctrl
& ~(1<<1)));
1759 REG_WR(bp
, xmac_base
+ XMAC_REG_PFC_CTRL_HI
,
1760 (pfc_ctrl
| (1<<1)));
1761 DP(NETIF_MSG_LINK
, "Disable XMAC on port %x\n", port
);
1762 val
= REG_RD(bp
, xmac_base
+ XMAC_REG_CTRL
);
1764 val
|= (XMAC_CTRL_REG_TX_EN
| XMAC_CTRL_REG_RX_EN
);
1766 val
&= ~(XMAC_CTRL_REG_TX_EN
| XMAC_CTRL_REG_RX_EN
);
1767 REG_WR(bp
, xmac_base
+ XMAC_REG_CTRL
, val
);
1771 static int bnx2x_xmac_enable(struct link_params
*params
,
1772 struct link_vars
*vars
, u8 lb
)
1775 struct bnx2x
*bp
= params
->bp
;
1776 DP(NETIF_MSG_LINK
, "enabling XMAC\n");
1778 xmac_base
= (params
->port
) ? GRCBASE_XMAC1
: GRCBASE_XMAC0
;
1780 bnx2x_xmac_init(params
, vars
->line_speed
);
1782 /* This register determines on which events the MAC will assert
1783 * error on the i/f to the NIG along w/ EOP.
1786 /* This register tells the NIG whether to send traffic to UMAC
1789 REG_WR(bp
, NIG_REG_EGRESS_EMAC0_PORT
+ params
->port
*4, 0);
1791 /* When XMAC is in XLGMII mode, disable sending idles for fault
1794 if (!(params
->phy
[INT_PHY
].flags
& FLAGS_TX_ERROR_CHECK
)) {
1795 REG_WR(bp
, xmac_base
+ XMAC_REG_RX_LSS_CTRL
,
1796 (XMAC_RX_LSS_CTRL_REG_LOCAL_FAULT_DISABLE
|
1797 XMAC_RX_LSS_CTRL_REG_REMOTE_FAULT_DISABLE
));
1798 REG_WR(bp
, xmac_base
+ XMAC_REG_CLEAR_RX_LSS_STATUS
, 0);
1799 REG_WR(bp
, xmac_base
+ XMAC_REG_CLEAR_RX_LSS_STATUS
,
1800 XMAC_CLEAR_RX_LSS_STATUS_REG_CLEAR_LOCAL_FAULT_STATUS
|
1801 XMAC_CLEAR_RX_LSS_STATUS_REG_CLEAR_REMOTE_FAULT_STATUS
);
1803 /* Set Max packet size */
1804 REG_WR(bp
, xmac_base
+ XMAC_REG_RX_MAX_SIZE
, 0x2710);
1806 /* CRC append for Tx packets */
1807 REG_WR(bp
, xmac_base
+ XMAC_REG_TX_CTRL
, 0xC800);
1810 bnx2x_update_pfc_xmac(params
, vars
, 0);
1812 if (vars
->eee_status
& SHMEM_EEE_ADV_STATUS_MASK
) {
1813 DP(NETIF_MSG_LINK
, "Setting XMAC for EEE\n");
1814 REG_WR(bp
, xmac_base
+ XMAC_REG_EEE_TIMERS_HI
, 0x1380008);
1815 REG_WR(bp
, xmac_base
+ XMAC_REG_EEE_CTRL
, 0x1);
1817 REG_WR(bp
, xmac_base
+ XMAC_REG_EEE_CTRL
, 0x0);
1820 /* Enable TX and RX */
1821 val
= XMAC_CTRL_REG_TX_EN
| XMAC_CTRL_REG_RX_EN
;
1823 /* Set MAC in XLGMII mode for dual-mode */
1824 if ((vars
->line_speed
== SPEED_20000
) &&
1825 (params
->phy
[INT_PHY
].supported
&
1826 SUPPORTED_20000baseKR2_Full
))
1827 val
|= XMAC_CTRL_REG_XLGMII_ALIGN_ENB
;
1829 /* Check loopback mode */
1831 val
|= XMAC_CTRL_REG_LINE_LOCAL_LPBK
;
1832 REG_WR(bp
, xmac_base
+ XMAC_REG_CTRL
, val
);
1833 bnx2x_set_xumac_nig(params
,
1834 ((vars
->flow_ctrl
& BNX2X_FLOW_CTRL_TX
) != 0), 1);
1836 vars
->mac_type
= MAC_TYPE_XMAC
;
1841 static int bnx2x_emac_enable(struct link_params
*params
,
1842 struct link_vars
*vars
, u8 lb
)
1844 struct bnx2x
*bp
= params
->bp
;
1845 u8 port
= params
->port
;
1846 u32 emac_base
= port
? GRCBASE_EMAC1
: GRCBASE_EMAC0
;
1849 DP(NETIF_MSG_LINK
, "enabling EMAC\n");
1852 REG_WR(bp
, GRCBASE_MISC
+ MISC_REGISTERS_RESET_REG_2_CLEAR
,
1853 (MISC_REGISTERS_RESET_REG_2_RST_BMAC0
<< port
));
1855 /* enable emac and not bmac */
1856 REG_WR(bp
, NIG_REG_EGRESS_EMAC0_PORT
+ port
*4, 1);
1859 if (vars
->phy_flags
& PHY_XGXS_FLAG
) {
1860 u32 ser_lane
= ((params
->lane_config
&
1861 PORT_HW_CFG_LANE_SWAP_CFG_MASTER_MASK
) >>
1862 PORT_HW_CFG_LANE_SWAP_CFG_MASTER_SHIFT
);
1864 DP(NETIF_MSG_LINK
, "XGXS\n");
1865 /* select the master lanes (out of 0-3) */
1866 REG_WR(bp
, NIG_REG_XGXS_LANE_SEL_P0
+ port
*4, ser_lane
);
1868 REG_WR(bp
, NIG_REG_XGXS_SERDES0_MODE_SEL
+ port
*4, 1);
1870 } else { /* SerDes */
1871 DP(NETIF_MSG_LINK
, "SerDes\n");
1873 REG_WR(bp
, NIG_REG_XGXS_SERDES0_MODE_SEL
+ port
*4, 0);
1876 bnx2x_bits_en(bp
, emac_base
+ EMAC_REG_EMAC_RX_MODE
,
1877 EMAC_RX_MODE_RESET
);
1878 bnx2x_bits_en(bp
, emac_base
+ EMAC_REG_EMAC_TX_MODE
,
1879 EMAC_TX_MODE_RESET
);
1881 /* pause enable/disable */
1882 bnx2x_bits_dis(bp
, emac_base
+ EMAC_REG_EMAC_RX_MODE
,
1883 EMAC_RX_MODE_FLOW_EN
);
1885 bnx2x_bits_dis(bp
, emac_base
+ EMAC_REG_EMAC_TX_MODE
,
1886 (EMAC_TX_MODE_EXT_PAUSE_EN
|
1887 EMAC_TX_MODE_FLOW_EN
));
1888 if (!(params
->feature_config_flags
&
1889 FEATURE_CONFIG_PFC_ENABLED
)) {
1890 if (vars
->flow_ctrl
& BNX2X_FLOW_CTRL_RX
)
1891 bnx2x_bits_en(bp
, emac_base
+
1892 EMAC_REG_EMAC_RX_MODE
,
1893 EMAC_RX_MODE_FLOW_EN
);
1895 if (vars
->flow_ctrl
& BNX2X_FLOW_CTRL_TX
)
1896 bnx2x_bits_en(bp
, emac_base
+
1897 EMAC_REG_EMAC_TX_MODE
,
1898 (EMAC_TX_MODE_EXT_PAUSE_EN
|
1899 EMAC_TX_MODE_FLOW_EN
));
1901 bnx2x_bits_en(bp
, emac_base
+ EMAC_REG_EMAC_TX_MODE
,
1902 EMAC_TX_MODE_FLOW_EN
);
1904 /* KEEP_VLAN_TAG, promiscuous */
1905 val
= REG_RD(bp
, emac_base
+ EMAC_REG_EMAC_RX_MODE
);
1906 val
|= EMAC_RX_MODE_KEEP_VLAN_TAG
| EMAC_RX_MODE_PROMISCUOUS
;
1908 /* Setting this bit causes MAC control frames (except for pause
1909 * frames) to be passed on for processing. This setting has no
1910 * affect on the operation of the pause frames. This bit effects
1911 * all packets regardless of RX Parser packet sorting logic.
1912 * Turn the PFC off to make sure we are in Xon state before
1915 EMAC_WR(bp
, EMAC_REG_RX_PFC_MODE
, 0);
1916 if (params
->feature_config_flags
& FEATURE_CONFIG_PFC_ENABLED
) {
1917 DP(NETIF_MSG_LINK
, "PFC is enabled\n");
1918 /* Enable PFC again */
1919 EMAC_WR(bp
, EMAC_REG_RX_PFC_MODE
,
1920 EMAC_REG_RX_PFC_MODE_RX_EN
|
1921 EMAC_REG_RX_PFC_MODE_TX_EN
|
1922 EMAC_REG_RX_PFC_MODE_PRIORITIES
);
1924 EMAC_WR(bp
, EMAC_REG_RX_PFC_PARAM
,
1926 EMAC_REG_RX_PFC_PARAM_OPCODE_BITSHIFT
) |
1928 EMAC_REG_RX_PFC_PARAM_PRIORITY_EN_BITSHIFT
)));
1929 val
|= EMAC_RX_MODE_KEEP_MAC_CONTROL
;
1931 EMAC_WR(bp
, EMAC_REG_EMAC_RX_MODE
, val
);
1934 val
= REG_RD(bp
, emac_base
+ EMAC_REG_EMAC_MODE
);
1939 EMAC_WR(bp
, EMAC_REG_EMAC_MODE
, val
);
1942 REG_WR(bp
, NIG_REG_NIG_EMAC0_EN
+ port
*4, 1);
1944 /* Enable emac for jumbo packets */
1945 EMAC_WR(bp
, EMAC_REG_EMAC_RX_MTU_SIZE
,
1946 (EMAC_RX_MTU_SIZE_JUMBO_ENA
|
1947 (ETH_MAX_JUMBO_PACKET_SIZE
+ ETH_OVREHEAD
)));
1950 REG_WR(bp
, NIG_REG_NIG_INGRESS_EMAC0_NO_CRC
+ port
*4, 0x1);
1952 /* Disable the NIG in/out to the bmac */
1953 REG_WR(bp
, NIG_REG_BMAC0_IN_EN
+ port
*4, 0x0);
1954 REG_WR(bp
, NIG_REG_BMAC0_PAUSE_OUT_EN
+ port
*4, 0x0);
1955 REG_WR(bp
, NIG_REG_BMAC0_OUT_EN
+ port
*4, 0x0);
1957 /* Enable the NIG in/out to the emac */
1958 REG_WR(bp
, NIG_REG_EMAC0_IN_EN
+ port
*4, 0x1);
1960 if ((params
->feature_config_flags
&
1961 FEATURE_CONFIG_PFC_ENABLED
) ||
1962 (vars
->flow_ctrl
& BNX2X_FLOW_CTRL_TX
))
1965 REG_WR(bp
, NIG_REG_EMAC0_PAUSE_OUT_EN
+ port
*4, val
);
1966 REG_WR(bp
, NIG_REG_EGRESS_EMAC0_OUT_EN
+ port
*4, 0x1);
1968 REG_WR(bp
, NIG_REG_BMAC0_REGS_OUT_EN
+ port
*4, 0x0);
1970 vars
->mac_type
= MAC_TYPE_EMAC
;
1974 static void bnx2x_update_pfc_bmac1(struct link_params
*params
,
1975 struct link_vars
*vars
)
1978 struct bnx2x
*bp
= params
->bp
;
1979 u32 bmac_addr
= params
->port
? NIG_REG_INGRESS_BMAC1_MEM
:
1980 NIG_REG_INGRESS_BMAC0_MEM
;
1983 if ((!(params
->feature_config_flags
&
1984 FEATURE_CONFIG_PFC_ENABLED
)) &&
1985 (vars
->flow_ctrl
& BNX2X_FLOW_CTRL_RX
))
1986 /* Enable BigMAC to react on received Pause packets */
1990 REG_WR_DMAE(bp
, bmac_addr
+ BIGMAC_REGISTER_RX_CONTROL
, wb_data
, 2);
1994 if (!(params
->feature_config_flags
&
1995 FEATURE_CONFIG_PFC_ENABLED
) &&
1996 (vars
->flow_ctrl
& BNX2X_FLOW_CTRL_TX
))
2000 REG_WR_DMAE(bp
, bmac_addr
+ BIGMAC_REGISTER_TX_CONTROL
, wb_data
, 2);
2003 static void bnx2x_update_pfc_bmac2(struct link_params
*params
,
2004 struct link_vars
*vars
,
2007 /* Set rx control: Strip CRC and enable BigMAC to relay
2008 * control packets to the system as well
2011 struct bnx2x
*bp
= params
->bp
;
2012 u32 bmac_addr
= params
->port
? NIG_REG_INGRESS_BMAC1_MEM
:
2013 NIG_REG_INGRESS_BMAC0_MEM
;
2016 if ((!(params
->feature_config_flags
&
2017 FEATURE_CONFIG_PFC_ENABLED
)) &&
2018 (vars
->flow_ctrl
& BNX2X_FLOW_CTRL_RX
))
2019 /* Enable BigMAC to react on received Pause packets */
2023 REG_WR_DMAE(bp
, bmac_addr
+ BIGMAC2_REGISTER_RX_CONTROL
, wb_data
, 2);
2028 if (!(params
->feature_config_flags
&
2029 FEATURE_CONFIG_PFC_ENABLED
) &&
2030 (vars
->flow_ctrl
& BNX2X_FLOW_CTRL_TX
))
2034 REG_WR_DMAE(bp
, bmac_addr
+ BIGMAC2_REGISTER_TX_CONTROL
, wb_data
, 2);
2036 if (params
->feature_config_flags
& FEATURE_CONFIG_PFC_ENABLED
) {
2037 DP(NETIF_MSG_LINK
, "PFC is enabled\n");
2038 /* Enable PFC RX & TX & STATS and set 8 COS */
2040 wb_data
[0] |= (1<<0); /* RX */
2041 wb_data
[0] |= (1<<1); /* TX */
2042 wb_data
[0] |= (1<<2); /* Force initial Xon */
2043 wb_data
[0] |= (1<<3); /* 8 cos */
2044 wb_data
[0] |= (1<<5); /* STATS */
2046 REG_WR_DMAE(bp
, bmac_addr
+ BIGMAC2_REGISTER_PFC_CONTROL
,
2048 /* Clear the force Xon */
2049 wb_data
[0] &= ~(1<<2);
2051 DP(NETIF_MSG_LINK
, "PFC is disabled\n");
2052 /* Disable PFC RX & TX & STATS and set 8 COS */
2057 REG_WR_DMAE(bp
, bmac_addr
+ BIGMAC2_REGISTER_PFC_CONTROL
, wb_data
, 2);
2059 /* Set Time (based unit is 512 bit time) between automatic
2060 * re-sending of PP packets amd enable automatic re-send of
2061 * Per-Priroity Packet as long as pp_gen is asserted and
2062 * pp_disable is low.
2065 if (params
->feature_config_flags
& FEATURE_CONFIG_PFC_ENABLED
)
2066 val
|= (1<<16); /* enable automatic re-send */
2070 REG_WR_DMAE(bp
, bmac_addr
+ BIGMAC2_REGISTER_TX_PAUSE_CONTROL
,
2074 val
= 0x3; /* Enable RX and TX */
2076 val
|= 0x4; /* Local loopback */
2077 DP(NETIF_MSG_LINK
, "enable bmac loopback\n");
2079 /* When PFC enabled, Pass pause frames towards the NIG. */
2080 if (params
->feature_config_flags
& FEATURE_CONFIG_PFC_ENABLED
)
2081 val
|= ((1<<6)|(1<<5));
2085 REG_WR_DMAE(bp
, bmac_addr
+ BIGMAC2_REGISTER_BMAC_CONTROL
, wb_data
, 2);
2088 /******************************************************************************
2090 * This function is needed because NIG ARB_CREDIT_WEIGHT_X are
2091 * not continues and ARB_CREDIT_WEIGHT_0 + offset is suitable.
2092 ******************************************************************************/
2093 static int bnx2x_pfc_nig_rx_priority_mask(struct bnx2x
*bp
,
2095 u32 priority_mask
, u8 port
)
2097 u32 nig_reg_rx_priority_mask_add
= 0;
2099 switch (cos_entry
) {
2101 nig_reg_rx_priority_mask_add
= (port
) ?
2102 NIG_REG_P1_RX_COS0_PRIORITY_MASK
:
2103 NIG_REG_P0_RX_COS0_PRIORITY_MASK
;
2106 nig_reg_rx_priority_mask_add
= (port
) ?
2107 NIG_REG_P1_RX_COS1_PRIORITY_MASK
:
2108 NIG_REG_P0_RX_COS1_PRIORITY_MASK
;
2111 nig_reg_rx_priority_mask_add
= (port
) ?
2112 NIG_REG_P1_RX_COS2_PRIORITY_MASK
:
2113 NIG_REG_P0_RX_COS2_PRIORITY_MASK
;
2118 nig_reg_rx_priority_mask_add
= NIG_REG_P0_RX_COS3_PRIORITY_MASK
;
2123 nig_reg_rx_priority_mask_add
= NIG_REG_P0_RX_COS4_PRIORITY_MASK
;
2128 nig_reg_rx_priority_mask_add
= NIG_REG_P0_RX_COS5_PRIORITY_MASK
;
2132 REG_WR(bp
, nig_reg_rx_priority_mask_add
, priority_mask
);
2136 static void bnx2x_update_mng(struct link_params
*params
, u32 link_status
)
2138 struct bnx2x
*bp
= params
->bp
;
2140 REG_WR(bp
, params
->shmem_base
+
2141 offsetof(struct shmem_region
,
2142 port_mb
[params
->port
].link_status
), link_status
);
2145 static void bnx2x_update_link_attr(struct link_params
*params
, u32 link_attr
)
2147 struct bnx2x
*bp
= params
->bp
;
2149 if (SHMEM2_HAS(bp
, link_attr_sync
))
2150 REG_WR(bp
, params
->shmem2_base
+
2151 offsetof(struct shmem2_region
,
2152 link_attr_sync
[params
->port
]), link_attr
);
2155 static void bnx2x_update_pfc_nig(struct link_params
*params
,
2156 struct link_vars
*vars
,
2157 struct bnx2x_nig_brb_pfc_port_params
*nig_params
)
2159 u32 xcm_mask
= 0, ppp_enable
= 0, pause_enable
= 0, llfc_out_en
= 0;
2160 u32 llfc_enable
= 0, xcm_out_en
= 0, hwpfc_enable
= 0;
2161 u32 pkt_priority_to_cos
= 0;
2162 struct bnx2x
*bp
= params
->bp
;
2163 u8 port
= params
->port
;
2165 int set_pfc
= params
->feature_config_flags
&
2166 FEATURE_CONFIG_PFC_ENABLED
;
2167 DP(NETIF_MSG_LINK
, "updating pfc nig parameters\n");
2169 /* When NIG_LLH0_XCM_MASK_REG_LLHX_XCM_MASK_BCN bit is set
2170 * MAC control frames (that are not pause packets)
2171 * will be forwarded to the XCM.
2173 xcm_mask
= REG_RD(bp
, port
? NIG_REG_LLH1_XCM_MASK
:
2174 NIG_REG_LLH0_XCM_MASK
);
2175 /* NIG params will override non PFC params, since it's possible to
2176 * do transition from PFC to SAFC
2186 xcm_mask
&= ~(port
? NIG_LLH1_XCM_MASK_REG_LLH1_XCM_MASK_BCN
:
2187 NIG_LLH0_XCM_MASK_REG_LLH0_XCM_MASK_BCN
);
2192 llfc_out_en
= nig_params
->llfc_out_en
;
2193 llfc_enable
= nig_params
->llfc_enable
;
2194 pause_enable
= nig_params
->pause_enable
;
2195 } else /* Default non PFC mode - PAUSE */
2198 xcm_mask
|= (port
? NIG_LLH1_XCM_MASK_REG_LLH1_XCM_MASK_BCN
:
2199 NIG_LLH0_XCM_MASK_REG_LLH0_XCM_MASK_BCN
);
2204 REG_WR(bp
, port
? NIG_REG_BRB1_PAUSE_IN_EN
:
2205 NIG_REG_BRB0_PAUSE_IN_EN
, pause_enable
);
2206 REG_WR(bp
, port
? NIG_REG_LLFC_OUT_EN_1
:
2207 NIG_REG_LLFC_OUT_EN_0
, llfc_out_en
);
2208 REG_WR(bp
, port
? NIG_REG_LLFC_ENABLE_1
:
2209 NIG_REG_LLFC_ENABLE_0
, llfc_enable
);
2210 REG_WR(bp
, port
? NIG_REG_PAUSE_ENABLE_1
:
2211 NIG_REG_PAUSE_ENABLE_0
, pause_enable
);
2213 REG_WR(bp
, port
? NIG_REG_PPP_ENABLE_1
:
2214 NIG_REG_PPP_ENABLE_0
, ppp_enable
);
2216 REG_WR(bp
, port
? NIG_REG_LLH1_XCM_MASK
:
2217 NIG_REG_LLH0_XCM_MASK
, xcm_mask
);
2219 REG_WR(bp
, port
? NIG_REG_LLFC_EGRESS_SRC_ENABLE_1
:
2220 NIG_REG_LLFC_EGRESS_SRC_ENABLE_0
, 0x7);
2222 /* Output enable for RX_XCM # IF */
2223 REG_WR(bp
, port
? NIG_REG_XCM1_OUT_EN
:
2224 NIG_REG_XCM0_OUT_EN
, xcm_out_en
);
2226 /* HW PFC TX enable */
2227 REG_WR(bp
, port
? NIG_REG_P1_HWPFC_ENABLE
:
2228 NIG_REG_P0_HWPFC_ENABLE
, hwpfc_enable
);
2232 pkt_priority_to_cos
= nig_params
->pkt_priority_to_cos
;
2234 for (i
= 0; i
< nig_params
->num_of_rx_cos_priority_mask
; i
++)
2235 bnx2x_pfc_nig_rx_priority_mask(bp
, i
,
2236 nig_params
->rx_cos_priority_mask
[i
], port
);
2238 REG_WR(bp
, port
? NIG_REG_LLFC_HIGH_PRIORITY_CLASSES_1
:
2239 NIG_REG_LLFC_HIGH_PRIORITY_CLASSES_0
,
2240 nig_params
->llfc_high_priority_classes
);
2242 REG_WR(bp
, port
? NIG_REG_LLFC_LOW_PRIORITY_CLASSES_1
:
2243 NIG_REG_LLFC_LOW_PRIORITY_CLASSES_0
,
2244 nig_params
->llfc_low_priority_classes
);
2246 REG_WR(bp
, port
? NIG_REG_P1_PKT_PRIORITY_TO_COS
:
2247 NIG_REG_P0_PKT_PRIORITY_TO_COS
,
2248 pkt_priority_to_cos
);
2251 int bnx2x_update_pfc(struct link_params
*params
,
2252 struct link_vars
*vars
,
2253 struct bnx2x_nig_brb_pfc_port_params
*pfc_params
)
2255 /* The PFC and pause are orthogonal to one another, meaning when
2256 * PFC is enabled, the pause are disabled, and when PFC is
2257 * disabled, pause are set according to the pause result.
2260 struct bnx2x
*bp
= params
->bp
;
2261 int bnx2x_status
= 0;
2262 u8 bmac_loopback
= (params
->loopback_mode
== LOOPBACK_BMAC
);
2264 if (params
->feature_config_flags
& FEATURE_CONFIG_PFC_ENABLED
)
2265 vars
->link_status
|= LINK_STATUS_PFC_ENABLED
;
2267 vars
->link_status
&= ~LINK_STATUS_PFC_ENABLED
;
2269 bnx2x_update_mng(params
, vars
->link_status
);
2271 /* Update NIG params */
2272 bnx2x_update_pfc_nig(params
, vars
, pfc_params
);
2275 return bnx2x_status
;
2277 DP(NETIF_MSG_LINK
, "About to update PFC in BMAC\n");
2279 if (CHIP_IS_E3(bp
)) {
2280 if (vars
->mac_type
== MAC_TYPE_XMAC
)
2281 bnx2x_update_pfc_xmac(params
, vars
, 0);
2283 val
= REG_RD(bp
, MISC_REG_RESET_REG_2
);
2285 (MISC_REGISTERS_RESET_REG_2_RST_BMAC0
<< params
->port
))
2287 DP(NETIF_MSG_LINK
, "About to update PFC in EMAC\n");
2288 bnx2x_emac_enable(params
, vars
, 0);
2289 return bnx2x_status
;
2292 bnx2x_update_pfc_bmac2(params
, vars
, bmac_loopback
);
2294 bnx2x_update_pfc_bmac1(params
, vars
);
2297 if ((params
->feature_config_flags
&
2298 FEATURE_CONFIG_PFC_ENABLED
) ||
2299 (vars
->flow_ctrl
& BNX2X_FLOW_CTRL_TX
))
2301 REG_WR(bp
, NIG_REG_BMAC0_PAUSE_OUT_EN
+ params
->port
*4, val
);
2303 return bnx2x_status
;
2306 static int bnx2x_bmac1_enable(struct link_params
*params
,
2307 struct link_vars
*vars
,
2310 struct bnx2x
*bp
= params
->bp
;
2311 u8 port
= params
->port
;
2312 u32 bmac_addr
= port
? NIG_REG_INGRESS_BMAC1_MEM
:
2313 NIG_REG_INGRESS_BMAC0_MEM
;
2317 DP(NETIF_MSG_LINK
, "Enabling BigMAC1\n");
2322 REG_WR_DMAE(bp
, bmac_addr
+ BIGMAC_REGISTER_BMAC_XGXS_CONTROL
,
2326 wb_data
[0] = ((params
->mac_addr
[2] << 24) |
2327 (params
->mac_addr
[3] << 16) |
2328 (params
->mac_addr
[4] << 8) |
2329 params
->mac_addr
[5]);
2330 wb_data
[1] = ((params
->mac_addr
[0] << 8) |
2331 params
->mac_addr
[1]);
2332 REG_WR_DMAE(bp
, bmac_addr
+ BIGMAC_REGISTER_TX_SOURCE_ADDR
, wb_data
, 2);
2338 DP(NETIF_MSG_LINK
, "enable bmac loopback\n");
2342 REG_WR_DMAE(bp
, bmac_addr
+ BIGMAC_REGISTER_BMAC_CONTROL
, wb_data
, 2);
2345 wb_data
[0] = ETH_MAX_JUMBO_PACKET_SIZE
+ ETH_OVREHEAD
;
2347 REG_WR_DMAE(bp
, bmac_addr
+ BIGMAC_REGISTER_RX_MAX_SIZE
, wb_data
, 2);
2349 bnx2x_update_pfc_bmac1(params
, vars
);
2352 wb_data
[0] = ETH_MAX_JUMBO_PACKET_SIZE
+ ETH_OVREHEAD
;
2354 REG_WR_DMAE(bp
, bmac_addr
+ BIGMAC_REGISTER_TX_MAX_SIZE
, wb_data
, 2);
2356 /* Set cnt max size */
2357 wb_data
[0] = ETH_MAX_JUMBO_PACKET_SIZE
+ ETH_OVREHEAD
;
2359 REG_WR_DMAE(bp
, bmac_addr
+ BIGMAC_REGISTER_CNT_MAX_SIZE
, wb_data
, 2);
2361 /* Configure SAFC */
2362 wb_data
[0] = 0x1000200;
2364 REG_WR_DMAE(bp
, bmac_addr
+ BIGMAC_REGISTER_RX_LLFC_MSG_FLDS
,
2370 static int bnx2x_bmac2_enable(struct link_params
*params
,
2371 struct link_vars
*vars
,
2374 struct bnx2x
*bp
= params
->bp
;
2375 u8 port
= params
->port
;
2376 u32 bmac_addr
= port
? NIG_REG_INGRESS_BMAC1_MEM
:
2377 NIG_REG_INGRESS_BMAC0_MEM
;
2380 DP(NETIF_MSG_LINK
, "Enabling BigMAC2\n");
2384 REG_WR_DMAE(bp
, bmac_addr
+ BIGMAC2_REGISTER_BMAC_CONTROL
, wb_data
, 2);
2387 /* XGXS control: Reset phy HW, MDIO registers, PHY PLL and BMAC */
2390 REG_WR_DMAE(bp
, bmac_addr
+ BIGMAC2_REGISTER_BMAC_XGXS_CONTROL
,
2396 wb_data
[0] = ((params
->mac_addr
[2] << 24) |
2397 (params
->mac_addr
[3] << 16) |
2398 (params
->mac_addr
[4] << 8) |
2399 params
->mac_addr
[5]);
2400 wb_data
[1] = ((params
->mac_addr
[0] << 8) |
2401 params
->mac_addr
[1]);
2402 REG_WR_DMAE(bp
, bmac_addr
+ BIGMAC2_REGISTER_TX_SOURCE_ADDR
,
2407 /* Configure SAFC */
2408 wb_data
[0] = 0x1000200;
2410 REG_WR_DMAE(bp
, bmac_addr
+ BIGMAC2_REGISTER_RX_LLFC_MSG_FLDS
,
2415 wb_data
[0] = ETH_MAX_JUMBO_PACKET_SIZE
+ ETH_OVREHEAD
;
2417 REG_WR_DMAE(bp
, bmac_addr
+ BIGMAC2_REGISTER_RX_MAX_SIZE
, wb_data
, 2);
2421 wb_data
[0] = ETH_MAX_JUMBO_PACKET_SIZE
+ ETH_OVREHEAD
;
2423 REG_WR_DMAE(bp
, bmac_addr
+ BIGMAC2_REGISTER_TX_MAX_SIZE
, wb_data
, 2);
2425 /* Set cnt max size */
2426 wb_data
[0] = ETH_MAX_JUMBO_PACKET_SIZE
+ ETH_OVREHEAD
- 2;
2428 REG_WR_DMAE(bp
, bmac_addr
+ BIGMAC2_REGISTER_CNT_MAX_SIZE
, wb_data
, 2);
2430 bnx2x_update_pfc_bmac2(params
, vars
, is_lb
);
2435 static int bnx2x_bmac_enable(struct link_params
*params
,
2436 struct link_vars
*vars
,
2437 u8 is_lb
, u8 reset_bmac
)
2440 u8 port
= params
->port
;
2441 struct bnx2x
*bp
= params
->bp
;
2443 /* Reset and unreset the BigMac */
2445 REG_WR(bp
, GRCBASE_MISC
+ MISC_REGISTERS_RESET_REG_2_CLEAR
,
2446 (MISC_REGISTERS_RESET_REG_2_RST_BMAC0
<< port
));
2447 usleep_range(1000, 2000);
2450 REG_WR(bp
, GRCBASE_MISC
+ MISC_REGISTERS_RESET_REG_2_SET
,
2451 (MISC_REGISTERS_RESET_REG_2_RST_BMAC0
<< port
));
2453 /* Enable access for bmac registers */
2454 REG_WR(bp
, NIG_REG_BMAC0_REGS_OUT_EN
+ port
*4, 0x1);
2456 /* Enable BMAC according to BMAC type*/
2458 rc
= bnx2x_bmac2_enable(params
, vars
, is_lb
);
2460 rc
= bnx2x_bmac1_enable(params
, vars
, is_lb
);
2461 REG_WR(bp
, NIG_REG_XGXS_SERDES0_MODE_SEL
+ port
*4, 0x1);
2462 REG_WR(bp
, NIG_REG_XGXS_LANE_SEL_P0
+ port
*4, 0x0);
2463 REG_WR(bp
, NIG_REG_EGRESS_EMAC0_PORT
+ port
*4, 0x0);
2465 if ((params
->feature_config_flags
&
2466 FEATURE_CONFIG_PFC_ENABLED
) ||
2467 (vars
->flow_ctrl
& BNX2X_FLOW_CTRL_TX
))
2469 REG_WR(bp
, NIG_REG_BMAC0_PAUSE_OUT_EN
+ port
*4, val
);
2470 REG_WR(bp
, NIG_REG_EGRESS_EMAC0_OUT_EN
+ port
*4, 0x0);
2471 REG_WR(bp
, NIG_REG_EMAC0_IN_EN
+ port
*4, 0x0);
2472 REG_WR(bp
, NIG_REG_EMAC0_PAUSE_OUT_EN
+ port
*4, 0x0);
2473 REG_WR(bp
, NIG_REG_BMAC0_IN_EN
+ port
*4, 0x1);
2474 REG_WR(bp
, NIG_REG_BMAC0_OUT_EN
+ port
*4, 0x1);
2476 vars
->mac_type
= MAC_TYPE_BMAC
;
2480 static void bnx2x_set_bmac_rx(struct bnx2x
*bp
, u32 chip_id
, u8 port
, u8 en
)
2482 u32 bmac_addr
= port
? NIG_REG_INGRESS_BMAC1_MEM
:
2483 NIG_REG_INGRESS_BMAC0_MEM
;
2485 u32 nig_bmac_enable
= REG_RD(bp
, NIG_REG_BMAC0_REGS_OUT_EN
+ port
*4);
2488 bmac_addr
+= BIGMAC2_REGISTER_BMAC_CONTROL
;
2490 bmac_addr
+= BIGMAC_REGISTER_BMAC_CONTROL
;
2491 /* Only if the bmac is out of reset */
2492 if (REG_RD(bp
, MISC_REG_RESET_REG_2
) &
2493 (MISC_REGISTERS_RESET_REG_2_RST_BMAC0
<< port
) &&
2495 /* Clear Rx Enable bit in BMAC_CONTROL register */
2496 REG_RD_DMAE(bp
, bmac_addr
, wb_data
, 2);
2498 wb_data
[0] |= BMAC_CONTROL_RX_ENABLE
;
2500 wb_data
[0] &= ~BMAC_CONTROL_RX_ENABLE
;
2501 REG_WR_DMAE(bp
, bmac_addr
, wb_data
, 2);
2502 usleep_range(1000, 2000);
2506 static int bnx2x_pbf_update(struct link_params
*params
, u32 flow_ctrl
,
2509 struct bnx2x
*bp
= params
->bp
;
2510 u8 port
= params
->port
;
2515 REG_WR(bp
, PBF_REG_DISABLE_NEW_TASK_PROC_P0
+ port
*4, 0x1);
2517 /* Wait for init credit */
2518 init_crd
= REG_RD(bp
, PBF_REG_P0_INIT_CRD
+ port
*4);
2519 crd
= REG_RD(bp
, PBF_REG_P0_CREDIT
+ port
*8);
2520 DP(NETIF_MSG_LINK
, "init_crd 0x%x crd 0x%x\n", init_crd
, crd
);
2522 while ((init_crd
!= crd
) && count
) {
2523 usleep_range(5000, 10000);
2524 crd
= REG_RD(bp
, PBF_REG_P0_CREDIT
+ port
*8);
2527 crd
= REG_RD(bp
, PBF_REG_P0_CREDIT
+ port
*8);
2528 if (init_crd
!= crd
) {
2529 DP(NETIF_MSG_LINK
, "BUG! init_crd 0x%x != crd 0x%x\n",
2534 if (flow_ctrl
& BNX2X_FLOW_CTRL_RX
||
2535 line_speed
== SPEED_10
||
2536 line_speed
== SPEED_100
||
2537 line_speed
== SPEED_1000
||
2538 line_speed
== SPEED_2500
) {
2539 REG_WR(bp
, PBF_REG_P0_PAUSE_ENABLE
+ port
*4, 1);
2540 /* Update threshold */
2541 REG_WR(bp
, PBF_REG_P0_ARB_THRSH
+ port
*4, 0);
2542 /* Update init credit */
2543 init_crd
= 778; /* (800-18-4) */
2546 u32 thresh
= (ETH_MAX_JUMBO_PACKET_SIZE
+
2548 REG_WR(bp
, PBF_REG_P0_PAUSE_ENABLE
+ port
*4, 0);
2549 /* Update threshold */
2550 REG_WR(bp
, PBF_REG_P0_ARB_THRSH
+ port
*4, thresh
);
2551 /* Update init credit */
2552 switch (line_speed
) {
2554 init_crd
= thresh
+ 553 - 22;
2557 DP(NETIF_MSG_LINK
, "Invalid line_speed 0x%x\n",
2562 REG_WR(bp
, PBF_REG_P0_INIT_CRD
+ port
*4, init_crd
);
2563 DP(NETIF_MSG_LINK
, "PBF updated to speed %d credit %d\n",
2564 line_speed
, init_crd
);
2566 /* Probe the credit changes */
2567 REG_WR(bp
, PBF_REG_INIT_P0
+ port
*4, 0x1);
2568 usleep_range(5000, 10000);
2569 REG_WR(bp
, PBF_REG_INIT_P0
+ port
*4, 0x0);
2572 REG_WR(bp
, PBF_REG_DISABLE_NEW_TASK_PROC_P0
+ port
*4, 0x0);
2577 * bnx2x_get_emac_base - retrive emac base address
2579 * @bp: driver handle
2580 * @mdc_mdio_access: access type
2583 * This function selects the MDC/MDIO access (through emac0 or
2584 * emac1) depend on the mdc_mdio_access, port, port swapped. Each
2585 * phy has a default access mode, which could also be overridden
2586 * by nvram configuration. This parameter, whether this is the
2587 * default phy configuration, or the nvram overrun
2588 * configuration, is passed here as mdc_mdio_access and selects
2589 * the emac_base for the CL45 read/writes operations
2591 static u32
bnx2x_get_emac_base(struct bnx2x
*bp
,
2592 u32 mdc_mdio_access
, u8 port
)
2595 switch (mdc_mdio_access
) {
2596 case SHARED_HW_CFG_MDC_MDIO_ACCESS1_PHY_TYPE
:
2598 case SHARED_HW_CFG_MDC_MDIO_ACCESS1_EMAC0
:
2599 if (REG_RD(bp
, NIG_REG_PORT_SWAP
))
2600 emac_base
= GRCBASE_EMAC1
;
2602 emac_base
= GRCBASE_EMAC0
;
2604 case SHARED_HW_CFG_MDC_MDIO_ACCESS1_EMAC1
:
2605 if (REG_RD(bp
, NIG_REG_PORT_SWAP
))
2606 emac_base
= GRCBASE_EMAC0
;
2608 emac_base
= GRCBASE_EMAC1
;
2610 case SHARED_HW_CFG_MDC_MDIO_ACCESS1_BOTH
:
2611 emac_base
= (port
) ? GRCBASE_EMAC1
: GRCBASE_EMAC0
;
2613 case SHARED_HW_CFG_MDC_MDIO_ACCESS1_SWAPPED
:
2614 emac_base
= (port
) ? GRCBASE_EMAC0
: GRCBASE_EMAC1
;
2623 /******************************************************************/
2624 /* CL22 access functions */
2625 /******************************************************************/
2626 static int bnx2x_cl22_write(struct bnx2x
*bp
,
2627 struct bnx2x_phy
*phy
,
2633 /* Switch to CL22 */
2634 mode
= REG_RD(bp
, phy
->mdio_ctrl
+ EMAC_REG_EMAC_MDIO_MODE
);
2635 REG_WR(bp
, phy
->mdio_ctrl
+ EMAC_REG_EMAC_MDIO_MODE
,
2636 mode
& ~EMAC_MDIO_MODE_CLAUSE_45
);
2639 tmp
= ((phy
->addr
<< 21) | (reg
<< 16) | val
|
2640 EMAC_MDIO_COMM_COMMAND_WRITE_22
|
2641 EMAC_MDIO_COMM_START_BUSY
);
2642 REG_WR(bp
, phy
->mdio_ctrl
+ EMAC_REG_EMAC_MDIO_COMM
, tmp
);
2644 for (i
= 0; i
< 50; i
++) {
2647 tmp
= REG_RD(bp
, phy
->mdio_ctrl
+ EMAC_REG_EMAC_MDIO_COMM
);
2648 if (!(tmp
& EMAC_MDIO_COMM_START_BUSY
)) {
2653 if (tmp
& EMAC_MDIO_COMM_START_BUSY
) {
2654 DP(NETIF_MSG_LINK
, "write phy register failed\n");
2657 REG_WR(bp
, phy
->mdio_ctrl
+ EMAC_REG_EMAC_MDIO_MODE
, mode
);
2661 static int bnx2x_cl22_read(struct bnx2x
*bp
,
2662 struct bnx2x_phy
*phy
,
2663 u16 reg
, u16
*ret_val
)
2669 /* Switch to CL22 */
2670 mode
= REG_RD(bp
, phy
->mdio_ctrl
+ EMAC_REG_EMAC_MDIO_MODE
);
2671 REG_WR(bp
, phy
->mdio_ctrl
+ EMAC_REG_EMAC_MDIO_MODE
,
2672 mode
& ~EMAC_MDIO_MODE_CLAUSE_45
);
2675 val
= ((phy
->addr
<< 21) | (reg
<< 16) |
2676 EMAC_MDIO_COMM_COMMAND_READ_22
|
2677 EMAC_MDIO_COMM_START_BUSY
);
2678 REG_WR(bp
, phy
->mdio_ctrl
+ EMAC_REG_EMAC_MDIO_COMM
, val
);
2680 for (i
= 0; i
< 50; i
++) {
2683 val
= REG_RD(bp
, phy
->mdio_ctrl
+ EMAC_REG_EMAC_MDIO_COMM
);
2684 if (!(val
& EMAC_MDIO_COMM_START_BUSY
)) {
2685 *ret_val
= (u16
)(val
& EMAC_MDIO_COMM_DATA
);
2690 if (val
& EMAC_MDIO_COMM_START_BUSY
) {
2691 DP(NETIF_MSG_LINK
, "read phy register failed\n");
2696 REG_WR(bp
, phy
->mdio_ctrl
+ EMAC_REG_EMAC_MDIO_MODE
, mode
);
2700 /******************************************************************/
2701 /* CL45 access functions */
2702 /******************************************************************/
2703 static int bnx2x_cl45_read(struct bnx2x
*bp
, struct bnx2x_phy
*phy
,
2704 u8 devad
, u16 reg
, u16
*ret_val
)
2710 if (phy
->flags
& FLAGS_MDC_MDIO_WA_G
) {
2711 chip_id
= (REG_RD(bp
, MISC_REG_CHIP_NUM
) << 16) |
2712 ((REG_RD(bp
, MISC_REG_CHIP_REV
) & 0xf) << 12);
2713 bnx2x_set_mdio_clk(bp
, chip_id
, phy
->mdio_ctrl
);
2716 if (phy
->flags
& FLAGS_MDC_MDIO_WA_B0
)
2717 bnx2x_bits_en(bp
, phy
->mdio_ctrl
+ EMAC_REG_EMAC_MDIO_STATUS
,
2718 EMAC_MDIO_STATUS_10MB
);
2720 val
= ((phy
->addr
<< 21) | (devad
<< 16) | reg
|
2721 EMAC_MDIO_COMM_COMMAND_ADDRESS
|
2722 EMAC_MDIO_COMM_START_BUSY
);
2723 REG_WR(bp
, phy
->mdio_ctrl
+ EMAC_REG_EMAC_MDIO_COMM
, val
);
2725 for (i
= 0; i
< 50; i
++) {
2728 val
= REG_RD(bp
, phy
->mdio_ctrl
+ EMAC_REG_EMAC_MDIO_COMM
);
2729 if (!(val
& EMAC_MDIO_COMM_START_BUSY
)) {
2734 if (val
& EMAC_MDIO_COMM_START_BUSY
) {
2735 DP(NETIF_MSG_LINK
, "read phy register failed\n");
2736 netdev_err(bp
->dev
, "MDC/MDIO access timeout\n");
2741 val
= ((phy
->addr
<< 21) | (devad
<< 16) |
2742 EMAC_MDIO_COMM_COMMAND_READ_45
|
2743 EMAC_MDIO_COMM_START_BUSY
);
2744 REG_WR(bp
, phy
->mdio_ctrl
+ EMAC_REG_EMAC_MDIO_COMM
, val
);
2746 for (i
= 0; i
< 50; i
++) {
2749 val
= REG_RD(bp
, phy
->mdio_ctrl
+
2750 EMAC_REG_EMAC_MDIO_COMM
);
2751 if (!(val
& EMAC_MDIO_COMM_START_BUSY
)) {
2752 *ret_val
= (u16
)(val
& EMAC_MDIO_COMM_DATA
);
2756 if (val
& EMAC_MDIO_COMM_START_BUSY
) {
2757 DP(NETIF_MSG_LINK
, "read phy register failed\n");
2758 netdev_err(bp
->dev
, "MDC/MDIO access timeout\n");
2763 /* Work around for E3 A0 */
2764 if (phy
->flags
& FLAGS_MDC_MDIO_WA
) {
2765 phy
->flags
^= FLAGS_DUMMY_READ
;
2766 if (phy
->flags
& FLAGS_DUMMY_READ
) {
2768 bnx2x_cl45_read(bp
, phy
, devad
, 0xf, &temp_val
);
2772 if (phy
->flags
& FLAGS_MDC_MDIO_WA_B0
)
2773 bnx2x_bits_dis(bp
, phy
->mdio_ctrl
+ EMAC_REG_EMAC_MDIO_STATUS
,
2774 EMAC_MDIO_STATUS_10MB
);
2778 static int bnx2x_cl45_write(struct bnx2x
*bp
, struct bnx2x_phy
*phy
,
2779 u8 devad
, u16 reg
, u16 val
)
2785 if (phy
->flags
& FLAGS_MDC_MDIO_WA_G
) {
2786 chip_id
= (REG_RD(bp
, MISC_REG_CHIP_NUM
) << 16) |
2787 ((REG_RD(bp
, MISC_REG_CHIP_REV
) & 0xf) << 12);
2788 bnx2x_set_mdio_clk(bp
, chip_id
, phy
->mdio_ctrl
);
2791 if (phy
->flags
& FLAGS_MDC_MDIO_WA_B0
)
2792 bnx2x_bits_en(bp
, phy
->mdio_ctrl
+ EMAC_REG_EMAC_MDIO_STATUS
,
2793 EMAC_MDIO_STATUS_10MB
);
2796 tmp
= ((phy
->addr
<< 21) | (devad
<< 16) | reg
|
2797 EMAC_MDIO_COMM_COMMAND_ADDRESS
|
2798 EMAC_MDIO_COMM_START_BUSY
);
2799 REG_WR(bp
, phy
->mdio_ctrl
+ EMAC_REG_EMAC_MDIO_COMM
, tmp
);
2801 for (i
= 0; i
< 50; i
++) {
2804 tmp
= REG_RD(bp
, phy
->mdio_ctrl
+ EMAC_REG_EMAC_MDIO_COMM
);
2805 if (!(tmp
& EMAC_MDIO_COMM_START_BUSY
)) {
2810 if (tmp
& EMAC_MDIO_COMM_START_BUSY
) {
2811 DP(NETIF_MSG_LINK
, "write phy register failed\n");
2812 netdev_err(bp
->dev
, "MDC/MDIO access timeout\n");
2816 tmp
= ((phy
->addr
<< 21) | (devad
<< 16) | val
|
2817 EMAC_MDIO_COMM_COMMAND_WRITE_45
|
2818 EMAC_MDIO_COMM_START_BUSY
);
2819 REG_WR(bp
, phy
->mdio_ctrl
+ EMAC_REG_EMAC_MDIO_COMM
, tmp
);
2821 for (i
= 0; i
< 50; i
++) {
2824 tmp
= REG_RD(bp
, phy
->mdio_ctrl
+
2825 EMAC_REG_EMAC_MDIO_COMM
);
2826 if (!(tmp
& EMAC_MDIO_COMM_START_BUSY
)) {
2831 if (tmp
& EMAC_MDIO_COMM_START_BUSY
) {
2832 DP(NETIF_MSG_LINK
, "write phy register failed\n");
2833 netdev_err(bp
->dev
, "MDC/MDIO access timeout\n");
2837 /* Work around for E3 A0 */
2838 if (phy
->flags
& FLAGS_MDC_MDIO_WA
) {
2839 phy
->flags
^= FLAGS_DUMMY_READ
;
2840 if (phy
->flags
& FLAGS_DUMMY_READ
) {
2842 bnx2x_cl45_read(bp
, phy
, devad
, 0xf, &temp_val
);
2845 if (phy
->flags
& FLAGS_MDC_MDIO_WA_B0
)
2846 bnx2x_bits_dis(bp
, phy
->mdio_ctrl
+ EMAC_REG_EMAC_MDIO_STATUS
,
2847 EMAC_MDIO_STATUS_10MB
);
2851 /******************************************************************/
2853 /******************************************************************/
2854 static u8
bnx2x_eee_has_cap(struct link_params
*params
)
2856 struct bnx2x
*bp
= params
->bp
;
2858 if (REG_RD(bp
, params
->shmem2_base
) <=
2859 offsetof(struct shmem2_region
, eee_status
[params
->port
]))
2865 static int bnx2x_eee_nvram_to_time(u32 nvram_mode
, u32
*idle_timer
)
2867 switch (nvram_mode
) {
2868 case PORT_FEAT_CFG_EEE_POWER_MODE_BALANCED
:
2869 *idle_timer
= EEE_MODE_NVRAM_BALANCED_TIME
;
2871 case PORT_FEAT_CFG_EEE_POWER_MODE_AGGRESSIVE
:
2872 *idle_timer
= EEE_MODE_NVRAM_AGGRESSIVE_TIME
;
2874 case PORT_FEAT_CFG_EEE_POWER_MODE_LOW_LATENCY
:
2875 *idle_timer
= EEE_MODE_NVRAM_LATENCY_TIME
;
2885 static int bnx2x_eee_time_to_nvram(u32 idle_timer
, u32
*nvram_mode
)
2887 switch (idle_timer
) {
2888 case EEE_MODE_NVRAM_BALANCED_TIME
:
2889 *nvram_mode
= PORT_FEAT_CFG_EEE_POWER_MODE_BALANCED
;
2891 case EEE_MODE_NVRAM_AGGRESSIVE_TIME
:
2892 *nvram_mode
= PORT_FEAT_CFG_EEE_POWER_MODE_AGGRESSIVE
;
2894 case EEE_MODE_NVRAM_LATENCY_TIME
:
2895 *nvram_mode
= PORT_FEAT_CFG_EEE_POWER_MODE_LOW_LATENCY
;
2898 *nvram_mode
= PORT_FEAT_CFG_EEE_POWER_MODE_DISABLED
;
2905 static u32
bnx2x_eee_calc_timer(struct link_params
*params
)
2907 u32 eee_mode
, eee_idle
;
2908 struct bnx2x
*bp
= params
->bp
;
2910 if (params
->eee_mode
& EEE_MODE_OVERRIDE_NVRAM
) {
2911 if (params
->eee_mode
& EEE_MODE_OUTPUT_TIME
) {
2912 /* time value in eee_mode --> used directly*/
2913 eee_idle
= params
->eee_mode
& EEE_MODE_TIMER_MASK
;
2915 /* hsi value in eee_mode --> time */
2916 if (bnx2x_eee_nvram_to_time(params
->eee_mode
&
2917 EEE_MODE_NVRAM_MASK
,
2922 /* hsi values in nvram --> time*/
2923 eee_mode
= ((REG_RD(bp
, params
->shmem_base
+
2924 offsetof(struct shmem_region
, dev_info
.
2925 port_feature_config
[params
->port
].
2927 PORT_FEAT_CFG_EEE_POWER_MODE_MASK
) >>
2928 PORT_FEAT_CFG_EEE_POWER_MODE_SHIFT
);
2930 if (bnx2x_eee_nvram_to_time(eee_mode
, &eee_idle
))
2937 static int bnx2x_eee_set_timers(struct link_params
*params
,
2938 struct link_vars
*vars
)
2940 u32 eee_idle
= 0, eee_mode
;
2941 struct bnx2x
*bp
= params
->bp
;
2943 eee_idle
= bnx2x_eee_calc_timer(params
);
2946 REG_WR(bp
, MISC_REG_CPMU_LP_IDLE_THR_P0
+ (params
->port
<< 2),
2948 } else if ((params
->eee_mode
& EEE_MODE_ENABLE_LPI
) &&
2949 (params
->eee_mode
& EEE_MODE_OVERRIDE_NVRAM
) &&
2950 (params
->eee_mode
& EEE_MODE_OUTPUT_TIME
)) {
2951 DP(NETIF_MSG_LINK
, "Error: Tx LPI is enabled with timer 0\n");
2955 vars
->eee_status
&= ~(SHMEM_EEE_TIMER_MASK
| SHMEM_EEE_TIME_OUTPUT_BIT
);
2956 if (params
->eee_mode
& EEE_MODE_OUTPUT_TIME
) {
2957 /* eee_idle in 1u --> eee_status in 16u */
2959 vars
->eee_status
|= (eee_idle
& SHMEM_EEE_TIMER_MASK
) |
2960 SHMEM_EEE_TIME_OUTPUT_BIT
;
2962 if (bnx2x_eee_time_to_nvram(eee_idle
, &eee_mode
))
2964 vars
->eee_status
|= eee_mode
;
2970 static int bnx2x_eee_initial_config(struct link_params
*params
,
2971 struct link_vars
*vars
, u8 mode
)
2973 vars
->eee_status
|= ((u32
) mode
) << SHMEM_EEE_SUPPORTED_SHIFT
;
2975 /* Propogate params' bits --> vars (for migration exposure) */
2976 if (params
->eee_mode
& EEE_MODE_ENABLE_LPI
)
2977 vars
->eee_status
|= SHMEM_EEE_LPI_REQUESTED_BIT
;
2979 vars
->eee_status
&= ~SHMEM_EEE_LPI_REQUESTED_BIT
;
2981 if (params
->eee_mode
& EEE_MODE_ADV_LPI
)
2982 vars
->eee_status
|= SHMEM_EEE_REQUESTED_BIT
;
2984 vars
->eee_status
&= ~SHMEM_EEE_REQUESTED_BIT
;
2986 return bnx2x_eee_set_timers(params
, vars
);
2989 static int bnx2x_eee_disable(struct bnx2x_phy
*phy
,
2990 struct link_params
*params
,
2991 struct link_vars
*vars
)
2993 struct bnx2x
*bp
= params
->bp
;
2995 /* Make Certain LPI is disabled */
2996 REG_WR(bp
, MISC_REG_CPMU_LP_FW_ENABLE_P0
+ (params
->port
<< 2), 0);
2998 bnx2x_cl45_write(bp
, phy
, MDIO_AN_DEVAD
, MDIO_AN_REG_EEE_ADV
, 0x0);
3000 vars
->eee_status
&= ~SHMEM_EEE_ADV_STATUS_MASK
;
3005 static int bnx2x_eee_advertise(struct bnx2x_phy
*phy
,
3006 struct link_params
*params
,
3007 struct link_vars
*vars
, u8 modes
)
3009 struct bnx2x
*bp
= params
->bp
;
3012 /* Mask events preventing LPI generation */
3013 REG_WR(bp
, MISC_REG_CPMU_LP_MASK_EXT_P0
+ (params
->port
<< 2), 0xfc20);
3015 if (modes
& SHMEM_EEE_10G_ADV
) {
3016 DP(NETIF_MSG_LINK
, "Advertise 10GBase-T EEE\n");
3019 if (modes
& SHMEM_EEE_1G_ADV
) {
3020 DP(NETIF_MSG_LINK
, "Advertise 1GBase-T EEE\n");
3024 bnx2x_cl45_write(bp
, phy
, MDIO_AN_DEVAD
, MDIO_AN_REG_EEE_ADV
, val
);
3026 vars
->eee_status
&= ~SHMEM_EEE_ADV_STATUS_MASK
;
3027 vars
->eee_status
|= (modes
<< SHMEM_EEE_ADV_STATUS_SHIFT
);
3032 static void bnx2x_update_mng_eee(struct link_params
*params
, u32 eee_status
)
3034 struct bnx2x
*bp
= params
->bp
;
3036 if (bnx2x_eee_has_cap(params
))
3037 REG_WR(bp
, params
->shmem2_base
+
3038 offsetof(struct shmem2_region
,
3039 eee_status
[params
->port
]), eee_status
);
3042 static void bnx2x_eee_an_resolve(struct bnx2x_phy
*phy
,
3043 struct link_params
*params
,
3044 struct link_vars
*vars
)
3046 struct bnx2x
*bp
= params
->bp
;
3047 u16 adv
= 0, lp
= 0;
3051 bnx2x_cl45_read(bp
, phy
, MDIO_AN_DEVAD
, MDIO_AN_REG_EEE_ADV
, &adv
);
3052 bnx2x_cl45_read(bp
, phy
, MDIO_AN_DEVAD
, MDIO_AN_REG_LP_EEE_ADV
, &lp
);
3055 lp_adv
|= SHMEM_EEE_100M_ADV
;
3057 if (vars
->line_speed
== SPEED_100
)
3059 DP(NETIF_MSG_LINK
, "EEE negotiated - 100M\n");
3063 lp_adv
|= SHMEM_EEE_1G_ADV
;
3065 if (vars
->line_speed
== SPEED_1000
)
3067 DP(NETIF_MSG_LINK
, "EEE negotiated - 1G\n");
3071 lp_adv
|= SHMEM_EEE_10G_ADV
;
3073 if (vars
->line_speed
== SPEED_10000
)
3075 DP(NETIF_MSG_LINK
, "EEE negotiated - 10G\n");
3079 vars
->eee_status
&= ~SHMEM_EEE_LP_ADV_STATUS_MASK
;
3080 vars
->eee_status
|= (lp_adv
<< SHMEM_EEE_LP_ADV_STATUS_SHIFT
);
3083 DP(NETIF_MSG_LINK
, "EEE is active\n");
3084 vars
->eee_status
|= SHMEM_EEE_ACTIVE_BIT
;
3089 /******************************************************************/
3090 /* BSC access functions from E3 */
3091 /******************************************************************/
3092 static void bnx2x_bsc_module_sel(struct link_params
*params
)
3095 u32 board_cfg
, sfp_ctrl
;
3096 u32 i2c_pins
[I2C_SWITCH_WIDTH
], i2c_val
[I2C_SWITCH_WIDTH
];
3097 struct bnx2x
*bp
= params
->bp
;
3098 u8 port
= params
->port
;
3099 /* Read I2C output PINs */
3100 board_cfg
= REG_RD(bp
, params
->shmem_base
+
3101 offsetof(struct shmem_region
,
3102 dev_info
.shared_hw_config
.board
));
3103 i2c_pins
[I2C_BSC0
] = board_cfg
& SHARED_HW_CFG_E3_I2C_MUX0_MASK
;
3104 i2c_pins
[I2C_BSC1
] = (board_cfg
& SHARED_HW_CFG_E3_I2C_MUX1_MASK
) >>
3105 SHARED_HW_CFG_E3_I2C_MUX1_SHIFT
;
3107 /* Read I2C output value */
3108 sfp_ctrl
= REG_RD(bp
, params
->shmem_base
+
3109 offsetof(struct shmem_region
,
3110 dev_info
.port_hw_config
[port
].e3_cmn_pin_cfg
));
3111 i2c_val
[I2C_BSC0
] = (sfp_ctrl
& PORT_HW_CFG_E3_I2C_MUX0_MASK
) > 0;
3112 i2c_val
[I2C_BSC1
] = (sfp_ctrl
& PORT_HW_CFG_E3_I2C_MUX1_MASK
) > 0;
3113 DP(NETIF_MSG_LINK
, "Setting BSC switch\n");
3114 for (idx
= 0; idx
< I2C_SWITCH_WIDTH
; idx
++)
3115 bnx2x_set_cfg_pin(bp
, i2c_pins
[idx
], i2c_val
[idx
]);
3118 static int bnx2x_bsc_read(struct link_params
*params
,
3119 struct bnx2x_phy
*phy
,
3128 struct bnx2x
*bp
= params
->bp
;
3130 if ((sl_devid
!= 0xa0) && (sl_devid
!= 0xa2)) {
3131 DP(NETIF_MSG_LINK
, "invalid sl_devid 0x%x\n", sl_devid
);
3135 if (xfer_cnt
> 16) {
3136 DP(NETIF_MSG_LINK
, "invalid xfer_cnt %d. Max is 16 bytes\n",
3140 bnx2x_bsc_module_sel(params
);
3142 xfer_cnt
= 16 - lc_addr
;
3144 /* Enable the engine */
3145 val
= REG_RD(bp
, MCP_REG_MCPR_IMC_COMMAND
);
3146 val
|= MCPR_IMC_COMMAND_ENABLE
;
3147 REG_WR(bp
, MCP_REG_MCPR_IMC_COMMAND
, val
);
3149 /* Program slave device ID */
3150 val
= (sl_devid
<< 16) | sl_addr
;
3151 REG_WR(bp
, MCP_REG_MCPR_IMC_SLAVE_CONTROL
, val
);
3153 /* Start xfer with 0 byte to update the address pointer ???*/
3154 val
= (MCPR_IMC_COMMAND_ENABLE
) |
3155 (MCPR_IMC_COMMAND_WRITE_OP
<<
3156 MCPR_IMC_COMMAND_OPERATION_BITSHIFT
) |
3157 (lc_addr
<< MCPR_IMC_COMMAND_TRANSFER_ADDRESS_BITSHIFT
) | (0);
3158 REG_WR(bp
, MCP_REG_MCPR_IMC_COMMAND
, val
);
3160 /* Poll for completion */
3162 val
= REG_RD(bp
, MCP_REG_MCPR_IMC_COMMAND
);
3163 while (((val
>> MCPR_IMC_COMMAND_IMC_STATUS_BITSHIFT
) & 0x3) != 1) {
3165 val
= REG_RD(bp
, MCP_REG_MCPR_IMC_COMMAND
);
3167 DP(NETIF_MSG_LINK
, "wr 0 byte timed out after %d try\n",
3176 /* Start xfer with read op */
3177 val
= (MCPR_IMC_COMMAND_ENABLE
) |
3178 (MCPR_IMC_COMMAND_READ_OP
<<
3179 MCPR_IMC_COMMAND_OPERATION_BITSHIFT
) |
3180 (lc_addr
<< MCPR_IMC_COMMAND_TRANSFER_ADDRESS_BITSHIFT
) |
3182 REG_WR(bp
, MCP_REG_MCPR_IMC_COMMAND
, val
);
3184 /* Poll for completion */
3186 val
= REG_RD(bp
, MCP_REG_MCPR_IMC_COMMAND
);
3187 while (((val
>> MCPR_IMC_COMMAND_IMC_STATUS_BITSHIFT
) & 0x3) != 1) {
3189 val
= REG_RD(bp
, MCP_REG_MCPR_IMC_COMMAND
);
3191 DP(NETIF_MSG_LINK
, "rd op timed out after %d try\n", i
);
3199 for (i
= (lc_addr
>> 2); i
< 4; i
++) {
3200 data_array
[i
] = REG_RD(bp
, (MCP_REG_MCPR_IMC_DATAREG0
+ i
*4));
3202 data_array
[i
] = ((data_array
[i
] & 0x000000ff) << 24) |
3203 ((data_array
[i
] & 0x0000ff00) << 8) |
3204 ((data_array
[i
] & 0x00ff0000) >> 8) |
3205 ((data_array
[i
] & 0xff000000) >> 24);
3211 static void bnx2x_cl45_read_or_write(struct bnx2x
*bp
, struct bnx2x_phy
*phy
,
3212 u8 devad
, u16 reg
, u16 or_val
)
3215 bnx2x_cl45_read(bp
, phy
, devad
, reg
, &val
);
3216 bnx2x_cl45_write(bp
, phy
, devad
, reg
, val
| or_val
);
3219 static void bnx2x_cl45_read_and_write(struct bnx2x
*bp
,
3220 struct bnx2x_phy
*phy
,
3221 u8 devad
, u16 reg
, u16 and_val
)
3224 bnx2x_cl45_read(bp
, phy
, devad
, reg
, &val
);
3225 bnx2x_cl45_write(bp
, phy
, devad
, reg
, val
& and_val
);
3228 int bnx2x_phy_read(struct link_params
*params
, u8 phy_addr
,
3229 u8 devad
, u16 reg
, u16
*ret_val
)
3232 /* Probe for the phy according to the given phy_addr, and execute
3233 * the read request on it
3235 for (phy_index
= 0; phy_index
< params
->num_phys
; phy_index
++) {
3236 if (params
->phy
[phy_index
].addr
== phy_addr
) {
3237 return bnx2x_cl45_read(params
->bp
,
3238 ¶ms
->phy
[phy_index
], devad
,
3245 int bnx2x_phy_write(struct link_params
*params
, u8 phy_addr
,
3246 u8 devad
, u16 reg
, u16 val
)
3249 /* Probe for the phy according to the given phy_addr, and execute
3250 * the write request on it
3252 for (phy_index
= 0; phy_index
< params
->num_phys
; phy_index
++) {
3253 if (params
->phy
[phy_index
].addr
== phy_addr
) {
3254 return bnx2x_cl45_write(params
->bp
,
3255 ¶ms
->phy
[phy_index
], devad
,
3261 static u8
bnx2x_get_warpcore_lane(struct bnx2x_phy
*phy
,
3262 struct link_params
*params
)
3265 struct bnx2x
*bp
= params
->bp
;
3266 u32 path_swap
, path_swap_ovr
;
3270 port
= params
->port
;
3272 if (bnx2x_is_4_port_mode(bp
)) {
3273 u32 port_swap
, port_swap_ovr
;
3275 /* Figure out path swap value */
3276 path_swap_ovr
= REG_RD(bp
, MISC_REG_FOUR_PORT_PATH_SWAP_OVWR
);
3277 if (path_swap_ovr
& 0x1)
3278 path_swap
= (path_swap_ovr
& 0x2);
3280 path_swap
= REG_RD(bp
, MISC_REG_FOUR_PORT_PATH_SWAP
);
3285 /* Figure out port swap value */
3286 port_swap_ovr
= REG_RD(bp
, MISC_REG_FOUR_PORT_PORT_SWAP_OVWR
);
3287 if (port_swap_ovr
& 0x1)
3288 port_swap
= (port_swap_ovr
& 0x2);
3290 port_swap
= REG_RD(bp
, MISC_REG_FOUR_PORT_PORT_SWAP
);
3295 lane
= (port
<<1) + path
;
3296 } else { /* Two port mode - no port swap */
3298 /* Figure out path swap value */
3300 REG_RD(bp
, MISC_REG_TWO_PORT_PATH_SWAP_OVWR
);
3301 if (path_swap_ovr
& 0x1) {
3302 path_swap
= (path_swap_ovr
& 0x2);
3305 REG_RD(bp
, MISC_REG_TWO_PORT_PATH_SWAP
);
3315 static void bnx2x_set_aer_mmd(struct link_params
*params
,
3316 struct bnx2x_phy
*phy
)
3319 u16 offset
, aer_val
;
3320 struct bnx2x
*bp
= params
->bp
;
3321 ser_lane
= ((params
->lane_config
&
3322 PORT_HW_CFG_LANE_SWAP_CFG_MASTER_MASK
) >>
3323 PORT_HW_CFG_LANE_SWAP_CFG_MASTER_SHIFT
);
3325 offset
= (phy
->type
== PORT_HW_CFG_XGXS_EXT_PHY_TYPE_DIRECT
) ?
3326 (phy
->addr
+ ser_lane
) : 0;
3328 if (USES_WARPCORE(bp
)) {
3329 aer_val
= bnx2x_get_warpcore_lane(phy
, params
);
3330 /* In Dual-lane mode, two lanes are joined together,
3331 * so in order to configure them, the AER broadcast method is
3333 * 0x200 is the broadcast address for lanes 0,1
3334 * 0x201 is the broadcast address for lanes 2,3
3336 if (phy
->flags
& FLAGS_WC_DUAL_MODE
)
3337 aer_val
= (aer_val
>> 1) | 0x200;
3338 } else if (CHIP_IS_E2(bp
))
3339 aer_val
= 0x3800 + offset
- 1;
3341 aer_val
= 0x3800 + offset
;
3343 CL22_WR_OVER_CL45(bp
, phy
, MDIO_REG_BANK_AER_BLOCK
,
3344 MDIO_AER_BLOCK_AER_REG
, aer_val
);
3348 /******************************************************************/
3349 /* Internal phy section */
3350 /******************************************************************/
3352 static void bnx2x_set_serdes_access(struct bnx2x
*bp
, u8 port
)
3354 u32 emac_base
= (port
) ? GRCBASE_EMAC1
: GRCBASE_EMAC0
;
3357 REG_WR(bp
, NIG_REG_SERDES0_CTRL_MD_ST
+ port
*0x10, 1);
3358 REG_WR(bp
, emac_base
+ EMAC_REG_EMAC_MDIO_COMM
, 0x245f8000);
3360 REG_WR(bp
, emac_base
+ EMAC_REG_EMAC_MDIO_COMM
, 0x245d000f);
3363 REG_WR(bp
, NIG_REG_SERDES0_CTRL_MD_ST
+ port
*0x10, 0);
3366 static void bnx2x_serdes_deassert(struct bnx2x
*bp
, u8 port
)
3370 DP(NETIF_MSG_LINK
, "bnx2x_serdes_deassert\n");
3372 val
= SERDES_RESET_BITS
<< (port
*16);
3374 /* Reset and unreset the SerDes/XGXS */
3375 REG_WR(bp
, GRCBASE_MISC
+ MISC_REGISTERS_RESET_REG_3_CLEAR
, val
);
3377 REG_WR(bp
, GRCBASE_MISC
+ MISC_REGISTERS_RESET_REG_3_SET
, val
);
3379 bnx2x_set_serdes_access(bp
, port
);
3381 REG_WR(bp
, NIG_REG_SERDES0_CTRL_MD_DEVAD
+ port
*0x10,
3382 DEFAULT_PHY_DEV_ADDR
);
3385 static void bnx2x_xgxs_specific_func(struct bnx2x_phy
*phy
,
3386 struct link_params
*params
,
3389 struct bnx2x
*bp
= params
->bp
;
3392 /* Set correct devad */
3393 REG_WR(bp
, NIG_REG_XGXS0_CTRL_MD_ST
+ params
->port
*0x18, 0);
3394 REG_WR(bp
, NIG_REG_XGXS0_CTRL_MD_DEVAD
+ params
->port
*0x18,
3400 static void bnx2x_xgxs_deassert(struct link_params
*params
)
3402 struct bnx2x
*bp
= params
->bp
;
3405 DP(NETIF_MSG_LINK
, "bnx2x_xgxs_deassert\n");
3406 port
= params
->port
;
3408 val
= XGXS_RESET_BITS
<< (port
*16);
3410 /* Reset and unreset the SerDes/XGXS */
3411 REG_WR(bp
, GRCBASE_MISC
+ MISC_REGISTERS_RESET_REG_3_CLEAR
, val
);
3413 REG_WR(bp
, GRCBASE_MISC
+ MISC_REGISTERS_RESET_REG_3_SET
, val
);
3414 bnx2x_xgxs_specific_func(¶ms
->phy
[INT_PHY
], params
,
3418 static void bnx2x_calc_ieee_aneg_adv(struct bnx2x_phy
*phy
,
3419 struct link_params
*params
, u16
*ieee_fc
)
3421 struct bnx2x
*bp
= params
->bp
;
3422 *ieee_fc
= MDIO_COMBO_IEEE0_AUTO_NEG_ADV_FULL_DUPLEX
;
3423 /* Resolve pause mode and advertisement Please refer to Table
3424 * 28B-3 of the 802.3ab-1999 spec
3427 switch (phy
->req_flow_ctrl
) {
3428 case BNX2X_FLOW_CTRL_AUTO
:
3429 if (params
->req_fc_auto_adv
== BNX2X_FLOW_CTRL_BOTH
)
3430 *ieee_fc
|= MDIO_COMBO_IEEE0_AUTO_NEG_ADV_PAUSE_BOTH
;
3433 MDIO_COMBO_IEEE0_AUTO_NEG_ADV_PAUSE_ASYMMETRIC
;
3436 case BNX2X_FLOW_CTRL_TX
:
3437 *ieee_fc
|= MDIO_COMBO_IEEE0_AUTO_NEG_ADV_PAUSE_ASYMMETRIC
;
3440 case BNX2X_FLOW_CTRL_RX
:
3441 case BNX2X_FLOW_CTRL_BOTH
:
3442 *ieee_fc
|= MDIO_COMBO_IEEE0_AUTO_NEG_ADV_PAUSE_BOTH
;
3445 case BNX2X_FLOW_CTRL_NONE
:
3447 *ieee_fc
|= MDIO_COMBO_IEEE0_AUTO_NEG_ADV_PAUSE_NONE
;
3450 DP(NETIF_MSG_LINK
, "ieee_fc = 0x%x\n", *ieee_fc
);
3453 static void set_phy_vars(struct link_params
*params
,
3454 struct link_vars
*vars
)
3456 struct bnx2x
*bp
= params
->bp
;
3457 u8 actual_phy_idx
, phy_index
, link_cfg_idx
;
3458 u8 phy_config_swapped
= params
->multi_phy_config
&
3459 PORT_HW_CFG_PHY_SWAPPED_ENABLED
;
3460 for (phy_index
= INT_PHY
; phy_index
< params
->num_phys
;
3462 link_cfg_idx
= LINK_CONFIG_IDX(phy_index
);
3463 actual_phy_idx
= phy_index
;
3464 if (phy_config_swapped
) {
3465 if (phy_index
== EXT_PHY1
)
3466 actual_phy_idx
= EXT_PHY2
;
3467 else if (phy_index
== EXT_PHY2
)
3468 actual_phy_idx
= EXT_PHY1
;
3470 params
->phy
[actual_phy_idx
].req_flow_ctrl
=
3471 params
->req_flow_ctrl
[link_cfg_idx
];
3473 params
->phy
[actual_phy_idx
].req_line_speed
=
3474 params
->req_line_speed
[link_cfg_idx
];
3476 params
->phy
[actual_phy_idx
].speed_cap_mask
=
3477 params
->speed_cap_mask
[link_cfg_idx
];
3479 params
->phy
[actual_phy_idx
].req_duplex
=
3480 params
->req_duplex
[link_cfg_idx
];
3482 if (params
->req_line_speed
[link_cfg_idx
] ==
3484 vars
->link_status
|= LINK_STATUS_AUTO_NEGOTIATE_ENABLED
;
3486 DP(NETIF_MSG_LINK
, "req_flow_ctrl %x, req_line_speed %x,"
3487 " speed_cap_mask %x\n",
3488 params
->phy
[actual_phy_idx
].req_flow_ctrl
,
3489 params
->phy
[actual_phy_idx
].req_line_speed
,
3490 params
->phy
[actual_phy_idx
].speed_cap_mask
);
3494 static void bnx2x_ext_phy_set_pause(struct link_params
*params
,
3495 struct bnx2x_phy
*phy
,
3496 struct link_vars
*vars
)
3499 struct bnx2x
*bp
= params
->bp
;
3500 /* Read modify write pause advertizing */
3501 bnx2x_cl45_read(bp
, phy
, MDIO_AN_DEVAD
, MDIO_AN_REG_ADV_PAUSE
, &val
);
3503 val
&= ~MDIO_AN_REG_ADV_PAUSE_BOTH
;
3505 /* Please refer to Table 28B-3 of 802.3ab-1999 spec. */
3506 bnx2x_calc_ieee_aneg_adv(phy
, params
, &vars
->ieee_fc
);
3507 if ((vars
->ieee_fc
&
3508 MDIO_COMBO_IEEE0_AUTO_NEG_ADV_PAUSE_ASYMMETRIC
) ==
3509 MDIO_COMBO_IEEE0_AUTO_NEG_ADV_PAUSE_ASYMMETRIC
) {
3510 val
|= MDIO_AN_REG_ADV_PAUSE_ASYMMETRIC
;
3512 if ((vars
->ieee_fc
&
3513 MDIO_COMBO_IEEE0_AUTO_NEG_ADV_PAUSE_BOTH
) ==
3514 MDIO_COMBO_IEEE0_AUTO_NEG_ADV_PAUSE_BOTH
) {
3515 val
|= MDIO_AN_REG_ADV_PAUSE_PAUSE
;
3517 DP(NETIF_MSG_LINK
, "Ext phy AN advertize 0x%x\n", val
);
3518 bnx2x_cl45_write(bp
, phy
, MDIO_AN_DEVAD
, MDIO_AN_REG_ADV_PAUSE
, val
);
3521 static void bnx2x_pause_resolve(struct link_vars
*vars
, u32 pause_result
)
3523 switch (pause_result
) { /* ASYM P ASYM P */
3524 case 0xb: /* 1 0 1 1 */
3525 vars
->flow_ctrl
= BNX2X_FLOW_CTRL_TX
;
3528 case 0xe: /* 1 1 1 0 */
3529 vars
->flow_ctrl
= BNX2X_FLOW_CTRL_RX
;
3532 case 0x5: /* 0 1 0 1 */
3533 case 0x7: /* 0 1 1 1 */
3534 case 0xd: /* 1 1 0 1 */
3535 case 0xf: /* 1 1 1 1 */
3536 vars
->flow_ctrl
= BNX2X_FLOW_CTRL_BOTH
;
3542 if (pause_result
& (1<<0))
3543 vars
->link_status
|= LINK_STATUS_LINK_PARTNER_SYMMETRIC_PAUSE
;
3544 if (pause_result
& (1<<1))
3545 vars
->link_status
|= LINK_STATUS_LINK_PARTNER_ASYMMETRIC_PAUSE
;
3549 static void bnx2x_ext_phy_update_adv_fc(struct bnx2x_phy
*phy
,
3550 struct link_params
*params
,
3551 struct link_vars
*vars
)
3553 u16 ld_pause
; /* local */
3554 u16 lp_pause
; /* link partner */
3556 struct bnx2x
*bp
= params
->bp
;
3557 if (phy
->type
== PORT_HW_CFG_XGXS_EXT_PHY_TYPE_BCM54618SE
) {
3558 bnx2x_cl22_read(bp
, phy
, 0x4, &ld_pause
);
3559 bnx2x_cl22_read(bp
, phy
, 0x5, &lp_pause
);
3560 } else if (CHIP_IS_E3(bp
) &&
3561 SINGLE_MEDIA_DIRECT(params
)) {
3562 u8 lane
= bnx2x_get_warpcore_lane(phy
, params
);
3563 u16 gp_status
, gp_mask
;
3564 bnx2x_cl45_read(bp
, phy
,
3565 MDIO_AN_DEVAD
, MDIO_WC_REG_GP2_STATUS_GP_2_4
,
3567 gp_mask
= (MDIO_WC_REG_GP2_STATUS_GP_2_4_CL73_AN_CMPL
|
3568 MDIO_WC_REG_GP2_STATUS_GP_2_4_CL37_LP_AN_CAP
) <<
3570 if ((gp_status
& gp_mask
) == gp_mask
) {
3571 bnx2x_cl45_read(bp
, phy
, MDIO_AN_DEVAD
,
3572 MDIO_AN_REG_ADV_PAUSE
, &ld_pause
);
3573 bnx2x_cl45_read(bp
, phy
, MDIO_AN_DEVAD
,
3574 MDIO_AN_REG_LP_AUTO_NEG
, &lp_pause
);
3576 bnx2x_cl45_read(bp
, phy
, MDIO_AN_DEVAD
,
3577 MDIO_AN_REG_CL37_FC_LD
, &ld_pause
);
3578 bnx2x_cl45_read(bp
, phy
, MDIO_AN_DEVAD
,
3579 MDIO_AN_REG_CL37_FC_LP
, &lp_pause
);
3580 ld_pause
= ((ld_pause
&
3581 MDIO_COMBO_IEEE0_AUTO_NEG_ADV_PAUSE_BOTH
)
3583 lp_pause
= ((lp_pause
&
3584 MDIO_COMBO_IEEE0_AUTO_NEG_ADV_PAUSE_BOTH
)
3588 bnx2x_cl45_read(bp
, phy
,
3590 MDIO_AN_REG_ADV_PAUSE
, &ld_pause
);
3591 bnx2x_cl45_read(bp
, phy
,
3593 MDIO_AN_REG_LP_AUTO_NEG
, &lp_pause
);
3595 pause_result
= (ld_pause
&
3596 MDIO_AN_REG_ADV_PAUSE_MASK
) >> 8;
3597 pause_result
|= (lp_pause
&
3598 MDIO_AN_REG_ADV_PAUSE_MASK
) >> 10;
3599 DP(NETIF_MSG_LINK
, "Ext PHY pause result 0x%x\n", pause_result
);
3600 bnx2x_pause_resolve(vars
, pause_result
);
3604 static u8
bnx2x_ext_phy_resolve_fc(struct bnx2x_phy
*phy
,
3605 struct link_params
*params
,
3606 struct link_vars
*vars
)
3609 vars
->flow_ctrl
= BNX2X_FLOW_CTRL_NONE
;
3610 if (phy
->req_flow_ctrl
!= BNX2X_FLOW_CTRL_AUTO
) {
3611 /* Update the advertised flow-controled of LD/LP in AN */
3612 if (phy
->req_line_speed
== SPEED_AUTO_NEG
)
3613 bnx2x_ext_phy_update_adv_fc(phy
, params
, vars
);
3614 /* But set the flow-control result as the requested one */
3615 vars
->flow_ctrl
= phy
->req_flow_ctrl
;
3616 } else if (phy
->req_line_speed
!= SPEED_AUTO_NEG
)
3617 vars
->flow_ctrl
= params
->req_fc_auto_adv
;
3618 else if (vars
->link_status
& LINK_STATUS_AUTO_NEGOTIATE_COMPLETE
) {
3620 bnx2x_ext_phy_update_adv_fc(phy
, params
, vars
);
3624 /******************************************************************/
3625 /* Warpcore section */
3626 /******************************************************************/
3627 /* The init_internal_warpcore should mirror the xgxs,
3628 * i.e. reset the lane (if needed), set aer for the
3629 * init configuration, and set/clear SGMII flag. Internal
3630 * phy init is done purely in phy_init stage.
3632 static void bnx2x_warpcore_enable_AN_KR2(struct bnx2x_phy
*phy
,
3633 struct link_params
*params
,
3634 struct link_vars
*vars
)
3636 struct bnx2x
*bp
= params
->bp
;
3638 static struct bnx2x_reg_set reg_set
[] = {
3639 /* Step 1 - Program the TX/RX alignment markers */
3640 {MDIO_WC_DEVAD
, MDIO_WC_REG_CL82_USERB1_TX_CTRL5
, 0xa157},
3641 {MDIO_WC_DEVAD
, MDIO_WC_REG_CL82_USERB1_TX_CTRL7
, 0xcbe2},
3642 {MDIO_WC_DEVAD
, MDIO_WC_REG_CL82_USERB1_TX_CTRL6
, 0x7537},
3643 {MDIO_WC_DEVAD
, MDIO_WC_REG_CL82_USERB1_TX_CTRL9
, 0xa157},
3644 {MDIO_WC_DEVAD
, MDIO_WC_REG_CL82_USERB1_RX_CTRL11
, 0xcbe2},
3645 {MDIO_WC_DEVAD
, MDIO_WC_REG_CL82_USERB1_RX_CTRL10
, 0x7537},
3646 /* Step 2 - Configure the NP registers */
3647 {MDIO_WC_DEVAD
, MDIO_WC_REG_CL73_USERB0_CTRL
, 0x000a},
3648 {MDIO_WC_DEVAD
, MDIO_WC_REG_CL73_BAM_CTRL1
, 0x6400},
3649 {MDIO_WC_DEVAD
, MDIO_WC_REG_CL73_BAM_CTRL3
, 0x0620},
3650 {MDIO_WC_DEVAD
, MDIO_WC_REG_CL73_BAM_CODE_FIELD
, 0x0157},
3651 {MDIO_WC_DEVAD
, MDIO_WC_REG_ETA_CL73_OUI1
, 0x6464},
3652 {MDIO_WC_DEVAD
, MDIO_WC_REG_ETA_CL73_OUI2
, 0x3150},
3653 {MDIO_WC_DEVAD
, MDIO_WC_REG_ETA_CL73_OUI3
, 0x3150},
3654 {MDIO_WC_DEVAD
, MDIO_WC_REG_ETA_CL73_LD_BAM_CODE
, 0x0157},
3655 {MDIO_WC_DEVAD
, MDIO_WC_REG_ETA_CL73_LD_UD_CODE
, 0x0620}
3657 DP(NETIF_MSG_LINK
, "Enabling 20G-KR2\n");
3659 bnx2x_cl45_read_or_write(bp
, phy
, MDIO_WC_DEVAD
,
3660 MDIO_WC_REG_CL49_USERB0_CTRL
, (3<<6));
3662 for (i
= 0; i
< ARRAY_SIZE(reg_set
); i
++)
3663 bnx2x_cl45_write(bp
, phy
, reg_set
[i
].devad
, reg_set
[i
].reg
,
3666 /* Start KR2 work-around timer which handles BCM8073 link-parner */
3667 vars
->link_attr_sync
|= LINK_ATTR_SYNC_KR2_ENABLE
;
3668 bnx2x_update_link_attr(params
, vars
->link_attr_sync
);
3671 static void bnx2x_warpcore_set_lpi_passthrough(struct bnx2x_phy
*phy
,
3672 struct link_params
*params
)
3674 struct bnx2x
*bp
= params
->bp
;
3676 DP(NETIF_MSG_LINK
, "Configure WC for LPI pass through\n");
3677 bnx2x_cl45_write(bp
, phy
, MDIO_WC_DEVAD
,
3678 MDIO_WC_REG_EEE_COMBO_CONTROL0
, 0x7c);
3679 bnx2x_cl45_read_or_write(bp
, phy
, MDIO_WC_DEVAD
,
3680 MDIO_WC_REG_DIGITAL4_MISC5
, 0xc000);
3683 static void bnx2x_warpcore_restart_AN_KR(struct bnx2x_phy
*phy
,
3684 struct link_params
*params
)
3686 /* Restart autoneg on the leading lane only */
3687 struct bnx2x
*bp
= params
->bp
;
3688 u16 lane
= bnx2x_get_warpcore_lane(phy
, params
);
3689 CL22_WR_OVER_CL45(bp
, phy
, MDIO_REG_BANK_AER_BLOCK
,
3690 MDIO_AER_BLOCK_AER_REG
, lane
);
3691 bnx2x_cl45_write(bp
, phy
, MDIO_AN_DEVAD
,
3692 MDIO_WC_REG_IEEE0BLK_MIICNTL
, 0x1200);
3695 bnx2x_set_aer_mmd(params
, phy
);
3698 static void bnx2x_warpcore_enable_AN_KR(struct bnx2x_phy
*phy
,
3699 struct link_params
*params
,
3700 struct link_vars
*vars
) {
3701 u16 lane
, i
, cl72_ctrl
, an_adv
= 0;
3703 struct bnx2x
*bp
= params
->bp
;
3704 static struct bnx2x_reg_set reg_set
[] = {
3705 {MDIO_WC_DEVAD
, MDIO_WC_REG_SERDESDIGITAL_CONTROL1000X2
, 0x7},
3706 {MDIO_PMA_DEVAD
, MDIO_WC_REG_IEEE0BLK_AUTONEGNP
, 0x0},
3707 {MDIO_WC_DEVAD
, MDIO_WC_REG_RX66_CONTROL
, 0x7415},
3708 {MDIO_WC_DEVAD
, MDIO_WC_REG_SERDESDIGITAL_MISC2
, 0x6190},
3709 /* Disable Autoneg: re-enable it after adv is done. */
3710 {MDIO_AN_DEVAD
, MDIO_WC_REG_IEEE0BLK_MIICNTL
, 0},
3711 {MDIO_PMA_DEVAD
, MDIO_WC_REG_PMD_KR_CONTROL
, 0x2},
3712 {MDIO_WC_DEVAD
, MDIO_WC_REG_CL72_USERB0_CL72_TX_FIR_TAP
, 0},
3714 DP(NETIF_MSG_LINK
, "Enable Auto Negotiation for KR\n");
3715 /* Set to default registers that may be overriden by 10G force */
3716 for (i
= 0; i
< ARRAY_SIZE(reg_set
); i
++)
3717 bnx2x_cl45_write(bp
, phy
, reg_set
[i
].devad
, reg_set
[i
].reg
,
3720 bnx2x_cl45_read(bp
, phy
, MDIO_WC_DEVAD
,
3721 MDIO_WC_REG_CL72_USERB0_CL72_MISC1_CONTROL
, &cl72_ctrl
);
3722 cl72_ctrl
&= 0x08ff;
3723 cl72_ctrl
|= 0x3800;
3724 bnx2x_cl45_write(bp
, phy
, MDIO_WC_DEVAD
,
3725 MDIO_WC_REG_CL72_USERB0_CL72_MISC1_CONTROL
, cl72_ctrl
);
3727 /* Check adding advertisement for 1G KX */
3728 if (((vars
->line_speed
== SPEED_AUTO_NEG
) &&
3729 (phy
->speed_cap_mask
& PORT_HW_CFG_SPEED_CAPABILITY_D0_1G
)) ||
3730 (vars
->line_speed
== SPEED_1000
)) {
3731 u32 addr
= MDIO_WC_REG_SERDESDIGITAL_CONTROL1000X2
;
3734 /* Enable CL37 1G Parallel Detect */
3735 bnx2x_cl45_read_or_write(bp
, phy
, MDIO_WC_DEVAD
, addr
, 0x1);
3736 DP(NETIF_MSG_LINK
, "Advertize 1G\n");
3738 if (((vars
->line_speed
== SPEED_AUTO_NEG
) &&
3739 (phy
->speed_cap_mask
& PORT_HW_CFG_SPEED_CAPABILITY_D0_10G
)) ||
3740 (vars
->line_speed
== SPEED_10000
)) {
3741 /* Check adding advertisement for 10G KR */
3743 /* Enable 10G Parallel Detect */
3744 CL22_WR_OVER_CL45(bp
, phy
, MDIO_REG_BANK_AER_BLOCK
,
3745 MDIO_AER_BLOCK_AER_REG
, 0);
3747 bnx2x_cl45_write(bp
, phy
, MDIO_AN_DEVAD
,
3748 MDIO_WC_REG_PAR_DET_10G_CTRL
, 1);
3749 bnx2x_set_aer_mmd(params
, phy
);
3750 DP(NETIF_MSG_LINK
, "Advertize 10G\n");
3753 /* Set Transmit PMD settings */
3754 lane
= bnx2x_get_warpcore_lane(phy
, params
);
3755 bnx2x_cl45_write(bp
, phy
, MDIO_WC_DEVAD
,
3756 MDIO_WC_REG_TX0_TX_DRIVER
+ 0x10*lane
,
3757 ((0x02 << MDIO_WC_REG_TX0_TX_DRIVER_POST2_COEFF_OFFSET
) |
3758 (0x06 << MDIO_WC_REG_TX0_TX_DRIVER_IDRIVER_OFFSET
) |
3759 (0x09 << MDIO_WC_REG_TX0_TX_DRIVER_IPRE_DRIVER_OFFSET
)));
3760 /* Configure the next lane if dual mode */
3761 if (phy
->flags
& FLAGS_WC_DUAL_MODE
)
3762 bnx2x_cl45_write(bp
, phy
, MDIO_WC_DEVAD
,
3763 MDIO_WC_REG_TX0_TX_DRIVER
+ 0x10*(lane
+1),
3765 MDIO_WC_REG_TX0_TX_DRIVER_POST2_COEFF_OFFSET
) |
3767 MDIO_WC_REG_TX0_TX_DRIVER_IDRIVER_OFFSET
) |
3769 MDIO_WC_REG_TX0_TX_DRIVER_IPRE_DRIVER_OFFSET
)));
3770 bnx2x_cl45_write(bp
, phy
, MDIO_WC_DEVAD
,
3771 MDIO_WC_REG_CL72_USERB0_CL72_OS_DEF_CTRL
,
3773 bnx2x_cl45_write(bp
, phy
, MDIO_WC_DEVAD
,
3774 MDIO_WC_REG_CL72_USERB0_CL72_2P5_DEF_CTRL
,
3777 /* Advertised speeds */
3778 bnx2x_cl45_write(bp
, phy
, MDIO_AN_DEVAD
,
3779 MDIO_WC_REG_AN_IEEE1BLK_AN_ADVERTISEMENT1
, an_adv
);
3781 /* Advertised and set FEC (Forward Error Correction) */
3782 bnx2x_cl45_write(bp
, phy
, MDIO_AN_DEVAD
,
3783 MDIO_WC_REG_AN_IEEE1BLK_AN_ADVERTISEMENT2
,
3784 (MDIO_WC_REG_AN_IEEE1BLK_AN_ADV2_FEC_ABILITY
|
3785 MDIO_WC_REG_AN_IEEE1BLK_AN_ADV2_FEC_REQ
));
3787 /* Enable CL37 BAM */
3788 if (REG_RD(bp
, params
->shmem_base
+
3789 offsetof(struct shmem_region
, dev_info
.
3790 port_hw_config
[params
->port
].default_cfg
)) &
3791 PORT_HW_CFG_ENABLE_BAM_ON_KR_ENABLED
) {
3792 bnx2x_cl45_read_or_write(bp
, phy
, MDIO_WC_DEVAD
,
3793 MDIO_WC_REG_DIGITAL6_MP5_NEXTPAGECTRL
,
3795 DP(NETIF_MSG_LINK
, "Enable CL37 BAM on KR\n");
3798 /* Advertise pause */
3799 bnx2x_ext_phy_set_pause(params
, phy
, vars
);
3800 /* Set KR Autoneg Work-Around flag for Warpcore version older than D108
3802 bnx2x_cl45_read(bp
, phy
, MDIO_WC_DEVAD
,
3803 MDIO_WC_REG_UC_INFO_B1_VERSION
, &ucode_ver
);
3804 if (ucode_ver
< 0xd108) {
3805 DP(NETIF_MSG_LINK
, "Enable AN KR work-around. WC ver:0x%x\n",
3807 vars
->rx_tx_asic_rst
= MAX_KR_LINK_RETRY
;
3809 bnx2x_cl45_read_or_write(bp
, phy
, MDIO_WC_DEVAD
,
3810 MDIO_WC_REG_DIGITAL5_MISC7
, 0x100);
3812 /* Over 1G - AN local device user page 1 */
3813 bnx2x_cl45_write(bp
, phy
, MDIO_WC_DEVAD
,
3814 MDIO_WC_REG_DIGITAL3_UP1
, 0x1f);
3816 if (((phy
->req_line_speed
== SPEED_AUTO_NEG
) &&
3817 (phy
->speed_cap_mask
& PORT_HW_CFG_SPEED_CAPABILITY_D0_20G
)) ||
3818 (phy
->req_line_speed
== SPEED_20000
)) {
3820 CL22_WR_OVER_CL45(bp
, phy
, MDIO_REG_BANK_AER_BLOCK
,
3821 MDIO_AER_BLOCK_AER_REG
, lane
);
3823 bnx2x_cl45_read_or_write(bp
, phy
, MDIO_WC_DEVAD
,
3824 MDIO_WC_REG_RX1_PCI_CTRL
+ (0x10*lane
),
3827 bnx2x_cl45_write(bp
, phy
, MDIO_WC_DEVAD
,
3828 MDIO_WC_REG_XGXS_X2_CONTROL3
, 0x7);
3829 bnx2x_set_aer_mmd(params
, phy
);
3831 bnx2x_warpcore_enable_AN_KR2(phy
, params
, vars
);
3834 /* Enable Autoneg: only on the main lane */
3835 bnx2x_warpcore_restart_AN_KR(phy
, params
);
3838 static void bnx2x_warpcore_set_10G_KR(struct bnx2x_phy
*phy
,
3839 struct link_params
*params
,
3840 struct link_vars
*vars
)
3842 struct bnx2x
*bp
= params
->bp
;
3844 static struct bnx2x_reg_set reg_set
[] = {
3845 /* Disable Autoneg */
3846 {MDIO_WC_DEVAD
, MDIO_WC_REG_SERDESDIGITAL_CONTROL1000X2
, 0x7},
3847 {MDIO_WC_DEVAD
, MDIO_WC_REG_CL72_USERB0_CL72_MISC1_CONTROL
,
3849 {MDIO_AN_DEVAD
, MDIO_WC_REG_AN_IEEE1BLK_AN_ADVERTISEMENT1
, 0},
3850 {MDIO_AN_DEVAD
, MDIO_WC_REG_IEEE0BLK_MIICNTL
, 0x0},
3851 {MDIO_WC_DEVAD
, MDIO_WC_REG_DIGITAL3_UP1
, 0x1},
3852 {MDIO_WC_DEVAD
, MDIO_WC_REG_DIGITAL5_MISC7
, 0xa},
3853 /* Leave cl72 training enable, needed for KR */
3854 {MDIO_PMA_DEVAD
, MDIO_WC_REG_PMD_KR_CONTROL
, 0x2}
3857 for (i
= 0; i
< ARRAY_SIZE(reg_set
); i
++)
3858 bnx2x_cl45_write(bp
, phy
, reg_set
[i
].devad
, reg_set
[i
].reg
,
3861 lane
= bnx2x_get_warpcore_lane(phy
, params
);
3862 /* Global registers */
3863 CL22_WR_OVER_CL45(bp
, phy
, MDIO_REG_BANK_AER_BLOCK
,
3864 MDIO_AER_BLOCK_AER_REG
, 0);
3865 /* Disable CL36 PCS Tx */
3866 bnx2x_cl45_read(bp
, phy
, MDIO_WC_DEVAD
,
3867 MDIO_WC_REG_XGXSBLK1_LANECTRL0
, &val16
);
3868 val16
&= ~(0x0011 << lane
);
3869 bnx2x_cl45_write(bp
, phy
, MDIO_WC_DEVAD
,
3870 MDIO_WC_REG_XGXSBLK1_LANECTRL0
, val16
);
3872 bnx2x_cl45_read(bp
, phy
, MDIO_WC_DEVAD
,
3873 MDIO_WC_REG_XGXSBLK1_LANECTRL1
, &val16
);
3874 val16
|= (0x0303 << (lane
<< 1));
3875 bnx2x_cl45_write(bp
, phy
, MDIO_WC_DEVAD
,
3876 MDIO_WC_REG_XGXSBLK1_LANECTRL1
, val16
);
3878 bnx2x_set_aer_mmd(params
, phy
);
3879 /* Set speed via PMA/PMD register */
3880 bnx2x_cl45_write(bp
, phy
, MDIO_PMA_DEVAD
,
3881 MDIO_WC_REG_IEEE0BLK_MIICNTL
, 0x2040);
3883 bnx2x_cl45_write(bp
, phy
, MDIO_PMA_DEVAD
,
3884 MDIO_WC_REG_IEEE0BLK_AUTONEGNP
, 0xB);
3886 /* Enable encoded forced speed */
3887 bnx2x_cl45_write(bp
, phy
, MDIO_WC_DEVAD
,
3888 MDIO_WC_REG_SERDESDIGITAL_MISC2
, 0x30);
3890 /* Turn TX scramble payload only the 64/66 scrambler */
3891 bnx2x_cl45_write(bp
, phy
, MDIO_WC_DEVAD
,
3892 MDIO_WC_REG_TX66_CONTROL
, 0x9);
3894 /* Turn RX scramble payload only the 64/66 scrambler */
3895 bnx2x_cl45_read_or_write(bp
, phy
, MDIO_WC_DEVAD
,
3896 MDIO_WC_REG_RX66_CONTROL
, 0xF9);
3898 /* Set and clear loopback to cause a reset to 64/66 decoder */
3899 bnx2x_cl45_write(bp
, phy
, MDIO_WC_DEVAD
,
3900 MDIO_WC_REG_IEEE0BLK_MIICNTL
, 0x4000);
3901 bnx2x_cl45_write(bp
, phy
, MDIO_WC_DEVAD
,
3902 MDIO_WC_REG_IEEE0BLK_MIICNTL
, 0x0);
3906 static void bnx2x_warpcore_set_10G_XFI(struct bnx2x_phy
*phy
,
3907 struct link_params
*params
,
3910 struct bnx2x
*bp
= params
->bp
;
3911 u16 misc1_val
, tap_val
, tx_driver_val
, lane
, val
;
3912 /* Hold rxSeqStart */
3913 bnx2x_cl45_read_or_write(bp
, phy
, MDIO_WC_DEVAD
,
3914 MDIO_WC_REG_DSC2B0_DSC_MISC_CTRL0
, 0x8000);
3916 /* Hold tx_fifo_reset */
3917 bnx2x_cl45_read_or_write(bp
, phy
, MDIO_WC_DEVAD
,
3918 MDIO_WC_REG_SERDESDIGITAL_CONTROL1000X3
, 0x1);
3920 /* Disable CL73 AN */
3921 bnx2x_cl45_write(bp
, phy
, MDIO_AN_DEVAD
, MDIO_AN_REG_CTRL
, 0);
3923 /* Disable 100FX Enable and Auto-Detect */
3924 bnx2x_cl45_read_and_write(bp
, phy
, MDIO_WC_DEVAD
,
3925 MDIO_WC_REG_FX100_CTRL1
, 0xFFFA);
3927 /* Disable 100FX Idle detect */
3928 bnx2x_cl45_read_or_write(bp
, phy
, MDIO_WC_DEVAD
,
3929 MDIO_WC_REG_FX100_CTRL3
, 0x0080);
3931 /* Set Block address to Remote PHY & Clear forced_speed[5] */
3932 bnx2x_cl45_read_and_write(bp
, phy
, MDIO_WC_DEVAD
,
3933 MDIO_WC_REG_DIGITAL4_MISC3
, 0xFF7F);
3935 /* Turn off auto-detect & fiber mode */
3936 bnx2x_cl45_read_and_write(bp
, phy
, MDIO_WC_DEVAD
,
3937 MDIO_WC_REG_SERDESDIGITAL_CONTROL1000X1
,
3940 /* Set filter_force_link, disable_false_link and parallel_detect */
3941 bnx2x_cl45_read(bp
, phy
, MDIO_WC_DEVAD
,
3942 MDIO_WC_REG_SERDESDIGITAL_CONTROL1000X2
, &val
);
3943 bnx2x_cl45_write(bp
, phy
, MDIO_WC_DEVAD
,
3944 MDIO_WC_REG_SERDESDIGITAL_CONTROL1000X2
,
3945 ((val
| 0x0006) & 0xFFFE));
3948 bnx2x_cl45_read(bp
, phy
, MDIO_WC_DEVAD
,
3949 MDIO_WC_REG_SERDESDIGITAL_MISC1
, &misc1_val
);
3951 misc1_val
&= ~(0x1f);
3955 tap_val
= ((0x08 << MDIO_WC_REG_TX_FIR_TAP_POST_TAP_OFFSET
) |
3956 (0x37 << MDIO_WC_REG_TX_FIR_TAP_MAIN_TAP_OFFSET
) |
3957 (0x00 << MDIO_WC_REG_TX_FIR_TAP_PRE_TAP_OFFSET
));
3959 ((0x00 << MDIO_WC_REG_TX0_TX_DRIVER_POST2_COEFF_OFFSET
) |
3960 (0x02 << MDIO_WC_REG_TX0_TX_DRIVER_IDRIVER_OFFSET
) |
3961 (0x03 << MDIO_WC_REG_TX0_TX_DRIVER_IPRE_DRIVER_OFFSET
));
3965 tap_val
= ((0x0f << MDIO_WC_REG_TX_FIR_TAP_POST_TAP_OFFSET
) |
3966 (0x2b << MDIO_WC_REG_TX_FIR_TAP_MAIN_TAP_OFFSET
) |
3967 (0x02 << MDIO_WC_REG_TX_FIR_TAP_PRE_TAP_OFFSET
));
3969 ((0x03 << MDIO_WC_REG_TX0_TX_DRIVER_POST2_COEFF_OFFSET
) |
3970 (0x02 << MDIO_WC_REG_TX0_TX_DRIVER_IDRIVER_OFFSET
) |
3971 (0x06 << MDIO_WC_REG_TX0_TX_DRIVER_IPRE_DRIVER_OFFSET
));
3973 bnx2x_cl45_write(bp
, phy
, MDIO_WC_DEVAD
,
3974 MDIO_WC_REG_SERDESDIGITAL_MISC1
, misc1_val
);
3976 /* Set Transmit PMD settings */
3977 lane
= bnx2x_get_warpcore_lane(phy
, params
);
3978 bnx2x_cl45_write(bp
, phy
, MDIO_WC_DEVAD
,
3979 MDIO_WC_REG_TX_FIR_TAP
,
3980 tap_val
| MDIO_WC_REG_TX_FIR_TAP_ENABLE
);
3981 bnx2x_cl45_write(bp
, phy
, MDIO_WC_DEVAD
,
3982 MDIO_WC_REG_TX0_TX_DRIVER
+ 0x10*lane
,
3985 /* Enable fiber mode, enable and invert sig_det */
3986 bnx2x_cl45_read_or_write(bp
, phy
, MDIO_WC_DEVAD
,
3987 MDIO_WC_REG_SERDESDIGITAL_CONTROL1000X1
, 0xd);
3989 /* Set Block address to Remote PHY & Set forced_speed[5], 40bit mode */
3990 bnx2x_cl45_read_or_write(bp
, phy
, MDIO_WC_DEVAD
,
3991 MDIO_WC_REG_DIGITAL4_MISC3
, 0x8080);
3993 bnx2x_warpcore_set_lpi_passthrough(phy
, params
);
3995 /* 10G XFI Full Duplex */
3996 bnx2x_cl45_write(bp
, phy
, MDIO_WC_DEVAD
,
3997 MDIO_WC_REG_IEEE0BLK_MIICNTL
, 0x100);
3999 /* Release tx_fifo_reset */
4000 bnx2x_cl45_read_and_write(bp
, phy
, MDIO_WC_DEVAD
,
4001 MDIO_WC_REG_SERDESDIGITAL_CONTROL1000X3
,
4003 /* Release rxSeqStart */
4004 bnx2x_cl45_read_and_write(bp
, phy
, MDIO_WC_DEVAD
,
4005 MDIO_WC_REG_DSC2B0_DSC_MISC_CTRL0
, 0x7FFF);
4008 static void bnx2x_warpcore_set_20G_force_KR2(struct bnx2x_phy
*phy
,
4009 struct link_params
*params
)
4012 struct bnx2x
*bp
= params
->bp
;
4013 /* Set global registers, so set AER lane to 0 */
4014 CL22_WR_OVER_CL45(bp
, phy
, MDIO_REG_BANK_AER_BLOCK
,
4015 MDIO_AER_BLOCK_AER_REG
, 0);
4017 /* Disable sequencer */
4018 bnx2x_cl45_read_and_write(bp
, phy
, MDIO_WC_DEVAD
,
4019 MDIO_WC_REG_XGXSBLK0_XGXSCONTROL
, ~(1<<13));
4021 bnx2x_set_aer_mmd(params
, phy
);
4023 bnx2x_cl45_read_and_write(bp
, phy
, MDIO_PMA_DEVAD
,
4024 MDIO_WC_REG_PMD_KR_CONTROL
, ~(1<<1));
4025 bnx2x_cl45_write(bp
, phy
, MDIO_AN_DEVAD
,
4026 MDIO_AN_REG_CTRL
, 0);
4028 bnx2x_cl45_read(bp
, phy
, MDIO_WC_DEVAD
,
4029 MDIO_WC_REG_CL73_USERB0_CTRL
, &val
);
4032 bnx2x_cl45_write(bp
, phy
, MDIO_WC_DEVAD
,
4033 MDIO_WC_REG_CL73_USERB0_CTRL
, val
);
4035 /* Set 20G KR2 force speed */
4036 bnx2x_cl45_read_or_write(bp
, phy
, MDIO_WC_DEVAD
,
4037 MDIO_WC_REG_SERDESDIGITAL_MISC1
, 0x1f);
4039 bnx2x_cl45_read_or_write(bp
, phy
, MDIO_WC_DEVAD
,
4040 MDIO_WC_REG_DIGITAL4_MISC3
, (1<<7));
4042 bnx2x_cl45_read(bp
, phy
, MDIO_WC_DEVAD
,
4043 MDIO_WC_REG_CL72_USERB0_CL72_MISC1_CONTROL
, &val
);
4046 bnx2x_cl45_write(bp
, phy
, MDIO_WC_DEVAD
,
4047 MDIO_WC_REG_CL72_USERB0_CL72_MISC1_CONTROL
, val
);
4048 bnx2x_cl45_write(bp
, phy
, MDIO_WC_DEVAD
,
4049 MDIO_WC_REG_CL72_USERB0_CL72_TX_FIR_TAP
, 0x835A);
4051 /* Enable sequencer (over lane 0) */
4052 CL22_WR_OVER_CL45(bp
, phy
, MDIO_REG_BANK_AER_BLOCK
,
4053 MDIO_AER_BLOCK_AER_REG
, 0);
4055 bnx2x_cl45_read_or_write(bp
, phy
, MDIO_WC_DEVAD
,
4056 MDIO_WC_REG_XGXSBLK0_XGXSCONTROL
, (1<<13));
4058 bnx2x_set_aer_mmd(params
, phy
);
4061 static void bnx2x_warpcore_set_20G_DXGXS(struct bnx2x
*bp
,
4062 struct bnx2x_phy
*phy
,
4065 /* Rx0 anaRxControl1G */
4066 bnx2x_cl45_write(bp
, phy
, MDIO_WC_DEVAD
,
4067 MDIO_WC_REG_RX0_ANARXCONTROL1G
, 0x90);
4069 /* Rx2 anaRxControl1G */
4070 bnx2x_cl45_write(bp
, phy
, MDIO_WC_DEVAD
,
4071 MDIO_WC_REG_RX2_ANARXCONTROL1G
, 0x90);
4073 bnx2x_cl45_write(bp
, phy
, MDIO_WC_DEVAD
,
4074 MDIO_WC_REG_RX66_SCW0
, 0xE070);
4076 bnx2x_cl45_write(bp
, phy
, MDIO_WC_DEVAD
,
4077 MDIO_WC_REG_RX66_SCW1
, 0xC0D0);
4079 bnx2x_cl45_write(bp
, phy
, MDIO_WC_DEVAD
,
4080 MDIO_WC_REG_RX66_SCW2
, 0xA0B0);
4082 bnx2x_cl45_write(bp
, phy
, MDIO_WC_DEVAD
,
4083 MDIO_WC_REG_RX66_SCW3
, 0x8090);
4085 bnx2x_cl45_write(bp
, phy
, MDIO_WC_DEVAD
,
4086 MDIO_WC_REG_RX66_SCW0_MASK
, 0xF0F0);
4088 bnx2x_cl45_write(bp
, phy
, MDIO_WC_DEVAD
,
4089 MDIO_WC_REG_RX66_SCW1_MASK
, 0xF0F0);
4091 bnx2x_cl45_write(bp
, phy
, MDIO_WC_DEVAD
,
4092 MDIO_WC_REG_RX66_SCW2_MASK
, 0xF0F0);
4094 bnx2x_cl45_write(bp
, phy
, MDIO_WC_DEVAD
,
4095 MDIO_WC_REG_RX66_SCW3_MASK
, 0xF0F0);
4097 /* Serdes Digital Misc1 */
4098 bnx2x_cl45_write(bp
, phy
, MDIO_WC_DEVAD
,
4099 MDIO_WC_REG_SERDESDIGITAL_MISC1
, 0x6008);
4101 /* Serdes Digital4 Misc3 */
4102 bnx2x_cl45_write(bp
, phy
, MDIO_WC_DEVAD
,
4103 MDIO_WC_REG_DIGITAL4_MISC3
, 0x8088);
4105 /* Set Transmit PMD settings */
4106 bnx2x_cl45_write(bp
, phy
, MDIO_WC_DEVAD
,
4107 MDIO_WC_REG_TX_FIR_TAP
,
4108 ((0x12 << MDIO_WC_REG_TX_FIR_TAP_POST_TAP_OFFSET
) |
4109 (0x2d << MDIO_WC_REG_TX_FIR_TAP_MAIN_TAP_OFFSET
) |
4110 (0x00 << MDIO_WC_REG_TX_FIR_TAP_PRE_TAP_OFFSET
) |
4111 MDIO_WC_REG_TX_FIR_TAP_ENABLE
));
4112 bnx2x_cl45_write(bp
, phy
, MDIO_WC_DEVAD
,
4113 MDIO_WC_REG_TX0_TX_DRIVER
+ 0x10*lane
,
4114 ((0x02 << MDIO_WC_REG_TX0_TX_DRIVER_POST2_COEFF_OFFSET
) |
4115 (0x02 << MDIO_WC_REG_TX0_TX_DRIVER_IDRIVER_OFFSET
) |
4116 (0x02 << MDIO_WC_REG_TX0_TX_DRIVER_IPRE_DRIVER_OFFSET
)));
4119 static void bnx2x_warpcore_set_sgmii_speed(struct bnx2x_phy
*phy
,
4120 struct link_params
*params
,
4124 struct bnx2x
*bp
= params
->bp
;
4125 u16 val16
, digctrl_kx1
, digctrl_kx2
;
4127 /* Clear XFI clock comp in non-10G single lane mode. */
4128 bnx2x_cl45_read_and_write(bp
, phy
, MDIO_WC_DEVAD
,
4129 MDIO_WC_REG_RX66_CONTROL
, ~(3<<13));
4131 bnx2x_warpcore_set_lpi_passthrough(phy
, params
);
4133 if (always_autoneg
|| phy
->req_line_speed
== SPEED_AUTO_NEG
) {
4135 bnx2x_cl45_read_or_write(bp
, phy
, MDIO_WC_DEVAD
,
4136 MDIO_WC_REG_COMBO_IEEE0_MIICTRL
,
4138 DP(NETIF_MSG_LINK
, "set SGMII AUTONEG\n");
4140 bnx2x_cl45_read(bp
, phy
, MDIO_WC_DEVAD
,
4141 MDIO_WC_REG_COMBO_IEEE0_MIICTRL
, &val16
);
4143 switch (phy
->req_line_speed
) {
4154 "Speed not supported: 0x%x\n", phy
->req_line_speed
);
4158 if (phy
->req_duplex
== DUPLEX_FULL
)
4161 bnx2x_cl45_write(bp
, phy
, MDIO_WC_DEVAD
,
4162 MDIO_WC_REG_COMBO_IEEE0_MIICTRL
, val16
);
4164 DP(NETIF_MSG_LINK
, "set SGMII force speed %d\n",
4165 phy
->req_line_speed
);
4166 bnx2x_cl45_read(bp
, phy
, MDIO_WC_DEVAD
,
4167 MDIO_WC_REG_COMBO_IEEE0_MIICTRL
, &val16
);
4168 DP(NETIF_MSG_LINK
, " (readback) %x\n", val16
);
4171 /* SGMII Slave mode and disable signal detect */
4172 bnx2x_cl45_read(bp
, phy
, MDIO_WC_DEVAD
,
4173 MDIO_WC_REG_SERDESDIGITAL_CONTROL1000X1
, &digctrl_kx1
);
4177 digctrl_kx1
&= 0xff4a;
4179 bnx2x_cl45_write(bp
, phy
, MDIO_WC_DEVAD
,
4180 MDIO_WC_REG_SERDESDIGITAL_CONTROL1000X1
,
4183 /* Turn off parallel detect */
4184 bnx2x_cl45_read(bp
, phy
, MDIO_WC_DEVAD
,
4185 MDIO_WC_REG_SERDESDIGITAL_CONTROL1000X2
, &digctrl_kx2
);
4186 bnx2x_cl45_write(bp
, phy
, MDIO_WC_DEVAD
,
4187 MDIO_WC_REG_SERDESDIGITAL_CONTROL1000X2
,
4188 (digctrl_kx2
& ~(1<<2)));
4190 /* Re-enable parallel detect */
4191 bnx2x_cl45_write(bp
, phy
, MDIO_WC_DEVAD
,
4192 MDIO_WC_REG_SERDESDIGITAL_CONTROL1000X2
,
4193 (digctrl_kx2
| (1<<2)));
4195 /* Enable autodet */
4196 bnx2x_cl45_write(bp
, phy
, MDIO_WC_DEVAD
,
4197 MDIO_WC_REG_SERDESDIGITAL_CONTROL1000X1
,
4198 (digctrl_kx1
| 0x10));
4201 static void bnx2x_warpcore_reset_lane(struct bnx2x
*bp
,
4202 struct bnx2x_phy
*phy
,
4206 /* Take lane out of reset after configuration is finished */
4207 bnx2x_cl45_read(bp
, phy
, MDIO_WC_DEVAD
,
4208 MDIO_WC_REG_DIGITAL5_MISC6
, &val
);
4213 bnx2x_cl45_write(bp
, phy
, MDIO_WC_DEVAD
,
4214 MDIO_WC_REG_DIGITAL5_MISC6
, val
);
4215 bnx2x_cl45_read(bp
, phy
, MDIO_WC_DEVAD
,
4216 MDIO_WC_REG_DIGITAL5_MISC6
, &val
);
4218 /* Clear SFI/XFI link settings registers */
4219 static void bnx2x_warpcore_clear_regs(struct bnx2x_phy
*phy
,
4220 struct link_params
*params
,
4223 struct bnx2x
*bp
= params
->bp
;
4225 static struct bnx2x_reg_set wc_regs
[] = {
4226 {MDIO_AN_DEVAD
, MDIO_AN_REG_CTRL
, 0},
4227 {MDIO_WC_DEVAD
, MDIO_WC_REG_FX100_CTRL1
, 0x014a},
4228 {MDIO_WC_DEVAD
, MDIO_WC_REG_FX100_CTRL3
, 0x0800},
4229 {MDIO_WC_DEVAD
, MDIO_WC_REG_DIGITAL4_MISC3
, 0x8008},
4230 {MDIO_WC_DEVAD
, MDIO_WC_REG_SERDESDIGITAL_CONTROL1000X1
,
4232 {MDIO_WC_DEVAD
, MDIO_WC_REG_SERDESDIGITAL_CONTROL1000X2
,
4234 {MDIO_WC_DEVAD
, MDIO_WC_REG_SERDESDIGITAL_CONTROL1000X3
,
4236 {MDIO_WC_DEVAD
, MDIO_WC_REG_SERDESDIGITAL_MISC1
, 0x6000},
4237 {MDIO_WC_DEVAD
, MDIO_WC_REG_TX_FIR_TAP
, 0x0000},
4238 {MDIO_WC_DEVAD
, MDIO_WC_REG_IEEE0BLK_MIICNTL
, 0x2040},
4239 {MDIO_WC_DEVAD
, MDIO_WC_REG_COMBO_IEEE0_MIICTRL
, 0x0140}
4241 /* Set XFI clock comp as default. */
4242 bnx2x_cl45_read_or_write(bp
, phy
, MDIO_WC_DEVAD
,
4243 MDIO_WC_REG_RX66_CONTROL
, (3<<13));
4245 for (i
= 0; i
< ARRAY_SIZE(wc_regs
); i
++)
4246 bnx2x_cl45_write(bp
, phy
, wc_regs
[i
].devad
, wc_regs
[i
].reg
,
4249 lane
= bnx2x_get_warpcore_lane(phy
, params
);
4250 bnx2x_cl45_write(bp
, phy
, MDIO_WC_DEVAD
,
4251 MDIO_WC_REG_TX0_TX_DRIVER
+ 0x10*lane
, 0x0990);
4255 static int bnx2x_get_mod_abs_int_cfg(struct bnx2x
*bp
,
4257 u32 shmem_base
, u8 port
,
4258 u8
*gpio_num
, u8
*gpio_port
)
4263 if (CHIP_IS_E3(bp
)) {
4264 cfg_pin
= (REG_RD(bp
, shmem_base
+
4265 offsetof(struct shmem_region
,
4266 dev_info
.port_hw_config
[port
].e3_sfp_ctrl
)) &
4267 PORT_HW_CFG_E3_MOD_ABS_MASK
) >>
4268 PORT_HW_CFG_E3_MOD_ABS_SHIFT
;
4270 /* Should not happen. This function called upon interrupt
4271 * triggered by GPIO ( since EPIO can only generate interrupts
4273 * So if this function was called and none of the GPIOs was set,
4274 * it means the shit hit the fan.
4276 if ((cfg_pin
< PIN_CFG_GPIO0_P0
) ||
4277 (cfg_pin
> PIN_CFG_GPIO3_P1
)) {
4279 "No cfg pin %x for module detect indication\n",
4284 *gpio_num
= (cfg_pin
- PIN_CFG_GPIO0_P0
) & 0x3;
4285 *gpio_port
= (cfg_pin
- PIN_CFG_GPIO0_P0
) >> 2;
4287 *gpio_num
= MISC_REGISTERS_GPIO_3
;
4294 static int bnx2x_is_sfp_module_plugged(struct bnx2x_phy
*phy
,
4295 struct link_params
*params
)
4297 struct bnx2x
*bp
= params
->bp
;
4298 u8 gpio_num
, gpio_port
;
4300 if (bnx2x_get_mod_abs_int_cfg(bp
, params
->chip_id
,
4301 params
->shmem_base
, params
->port
,
4302 &gpio_num
, &gpio_port
) != 0)
4304 gpio_val
= bnx2x_get_gpio(bp
, gpio_num
, gpio_port
);
4306 /* Call the handling function in case module is detected */
4312 static int bnx2x_warpcore_get_sigdet(struct bnx2x_phy
*phy
,
4313 struct link_params
*params
)
4315 u16 gp2_status_reg0
, lane
;
4316 struct bnx2x
*bp
= params
->bp
;
4318 lane
= bnx2x_get_warpcore_lane(phy
, params
);
4320 bnx2x_cl45_read(bp
, phy
, MDIO_WC_DEVAD
, MDIO_WC_REG_GP2_STATUS_GP_2_0
,
4323 return (gp2_status_reg0
>> (8+lane
)) & 0x1;
4326 static void bnx2x_warpcore_config_runtime(struct bnx2x_phy
*phy
,
4327 struct link_params
*params
,
4328 struct link_vars
*vars
)
4330 struct bnx2x
*bp
= params
->bp
;
4332 u16 gp_status1
= 0, lnkup
= 0, lnkup_kr
= 0;
4333 u16 lane
= bnx2x_get_warpcore_lane(phy
, params
);
4335 vars
->turn_to_run_wc_rt
= vars
->turn_to_run_wc_rt
? 0 : 1;
4337 if (!vars
->turn_to_run_wc_rt
)
4340 /* Return if there is no link partner */
4341 if (!(bnx2x_warpcore_get_sigdet(phy
, params
))) {
4342 DP(NETIF_MSG_LINK
, "bnx2x_warpcore_get_sigdet false\n");
4346 if (vars
->rx_tx_asic_rst
) {
4347 serdes_net_if
= (REG_RD(bp
, params
->shmem_base
+
4348 offsetof(struct shmem_region
, dev_info
.
4349 port_hw_config
[params
->port
].default_cfg
)) &
4350 PORT_HW_CFG_NET_SERDES_IF_MASK
);
4352 switch (serdes_net_if
) {
4353 case PORT_HW_CFG_NET_SERDES_IF_KR
:
4354 /* Do we get link yet? */
4355 bnx2x_cl45_read(bp
, phy
, MDIO_WC_DEVAD
, 0x81d1,
4357 lnkup
= (gp_status1
>> (8+lane
)) & 0x1;/* 1G */
4359 lnkup_kr
= (gp_status1
>> (12+lane
)) & 0x1;
4362 "gp_status1 0x%x\n", gp_status1
);
4364 if (lnkup_kr
|| lnkup
) {
4365 vars
->rx_tx_asic_rst
= 0;
4367 "link up, rx_tx_asic_rst 0x%x\n",
4368 vars
->rx_tx_asic_rst
);
4370 /* Reset the lane to see if link comes up.*/
4371 bnx2x_warpcore_reset_lane(bp
, phy
, 1);
4372 bnx2x_warpcore_reset_lane(bp
, phy
, 0);
4374 /* Restart Autoneg */
4375 bnx2x_cl45_write(bp
, phy
, MDIO_AN_DEVAD
,
4376 MDIO_WC_REG_IEEE0BLK_MIICNTL
, 0x1200);
4378 vars
->rx_tx_asic_rst
--;
4379 DP(NETIF_MSG_LINK
, "0x%x retry left\n",
4380 vars
->rx_tx_asic_rst
);
4388 } /*params->rx_tx_asic_rst*/
4391 static void bnx2x_warpcore_config_sfi(struct bnx2x_phy
*phy
,
4392 struct link_params
*params
)
4394 u16 lane
= bnx2x_get_warpcore_lane(phy
, params
);
4395 struct bnx2x
*bp
= params
->bp
;
4396 bnx2x_warpcore_clear_regs(phy
, params
, lane
);
4397 if ((params
->req_line_speed
[LINK_CONFIG_IDX(INT_PHY
)] ==
4399 (phy
->media_type
!= ETH_PHY_SFP_1G_FIBER
)) {
4400 DP(NETIF_MSG_LINK
, "Setting 10G SFI\n");
4401 bnx2x_warpcore_set_10G_XFI(phy
, params
, 0);
4403 DP(NETIF_MSG_LINK
, "Setting 1G Fiber\n");
4404 bnx2x_warpcore_set_sgmii_speed(phy
, params
, 1, 0);
4408 static void bnx2x_sfp_e3_set_transmitter(struct link_params
*params
,
4409 struct bnx2x_phy
*phy
,
4412 struct bnx2x
*bp
= params
->bp
;
4414 u8 port
= params
->port
;
4416 cfg_pin
= REG_RD(bp
, params
->shmem_base
+
4417 offsetof(struct shmem_region
,
4418 dev_info
.port_hw_config
[port
].e3_sfp_ctrl
)) &
4419 PORT_HW_CFG_E3_TX_LASER_MASK
;
4420 /* Set the !tx_en since this pin is DISABLE_TX_LASER */
4421 DP(NETIF_MSG_LINK
, "Setting WC TX to %d\n", tx_en
);
4423 /* For 20G, the expected pin to be used is 3 pins after the current */
4424 bnx2x_set_cfg_pin(bp
, cfg_pin
, tx_en
^ 1);
4425 if (phy
->speed_cap_mask
& PORT_HW_CFG_SPEED_CAPABILITY_D0_20G
)
4426 bnx2x_set_cfg_pin(bp
, cfg_pin
+ 3, tx_en
^ 1);
4429 static void bnx2x_warpcore_config_init(struct bnx2x_phy
*phy
,
4430 struct link_params
*params
,
4431 struct link_vars
*vars
)
4433 struct bnx2x
*bp
= params
->bp
;
4436 u16 lane
= bnx2x_get_warpcore_lane(phy
, params
);
4437 serdes_net_if
= (REG_RD(bp
, params
->shmem_base
+
4438 offsetof(struct shmem_region
, dev_info
.
4439 port_hw_config
[params
->port
].default_cfg
)) &
4440 PORT_HW_CFG_NET_SERDES_IF_MASK
);
4441 DP(NETIF_MSG_LINK
, "Begin Warpcore init, link_speed %d, "
4442 "serdes_net_if = 0x%x\n",
4443 vars
->line_speed
, serdes_net_if
);
4444 bnx2x_set_aer_mmd(params
, phy
);
4445 bnx2x_warpcore_reset_lane(bp
, phy
, 1);
4446 vars
->phy_flags
|= PHY_XGXS_FLAG
;
4447 if ((serdes_net_if
== PORT_HW_CFG_NET_SERDES_IF_SGMII
) ||
4448 (phy
->req_line_speed
&&
4449 ((phy
->req_line_speed
== SPEED_100
) ||
4450 (phy
->req_line_speed
== SPEED_10
)))) {
4451 vars
->phy_flags
|= PHY_SGMII_FLAG
;
4452 DP(NETIF_MSG_LINK
, "Setting SGMII mode\n");
4453 bnx2x_warpcore_clear_regs(phy
, params
, lane
);
4454 bnx2x_warpcore_set_sgmii_speed(phy
, params
, 0, 1);
4456 switch (serdes_net_if
) {
4457 case PORT_HW_CFG_NET_SERDES_IF_KR
:
4458 /* Enable KR Auto Neg */
4459 if (params
->loopback_mode
!= LOOPBACK_EXT
)
4460 bnx2x_warpcore_enable_AN_KR(phy
, params
, vars
);
4462 DP(NETIF_MSG_LINK
, "Setting KR 10G-Force\n");
4463 bnx2x_warpcore_set_10G_KR(phy
, params
, vars
);
4467 case PORT_HW_CFG_NET_SERDES_IF_XFI
:
4468 bnx2x_warpcore_clear_regs(phy
, params
, lane
);
4469 if (vars
->line_speed
== SPEED_10000
) {
4470 DP(NETIF_MSG_LINK
, "Setting 10G XFI\n");
4471 bnx2x_warpcore_set_10G_XFI(phy
, params
, 1);
4473 if (SINGLE_MEDIA_DIRECT(params
)) {
4474 DP(NETIF_MSG_LINK
, "1G Fiber\n");
4477 DP(NETIF_MSG_LINK
, "10/100/1G SGMII\n");
4480 bnx2x_warpcore_set_sgmii_speed(phy
,
4488 case PORT_HW_CFG_NET_SERDES_IF_SFI
:
4489 /* Issue Module detection if module is plugged, or
4490 * enabled transmitter to avoid current leakage in case
4491 * no module is connected
4493 if (bnx2x_is_sfp_module_plugged(phy
, params
))
4494 bnx2x_sfp_module_detection(phy
, params
);
4496 bnx2x_sfp_e3_set_transmitter(params
, phy
, 1);
4498 bnx2x_warpcore_config_sfi(phy
, params
);
4501 case PORT_HW_CFG_NET_SERDES_IF_DXGXS
:
4502 if (vars
->line_speed
!= SPEED_20000
) {
4503 DP(NETIF_MSG_LINK
, "Speed not supported yet\n");
4506 DP(NETIF_MSG_LINK
, "Setting 20G DXGXS\n");
4507 bnx2x_warpcore_set_20G_DXGXS(bp
, phy
, lane
);
4508 /* Issue Module detection */
4510 bnx2x_sfp_module_detection(phy
, params
);
4512 case PORT_HW_CFG_NET_SERDES_IF_KR2
:
4513 if (!params
->loopback_mode
) {
4514 bnx2x_warpcore_enable_AN_KR(phy
, params
, vars
);
4516 DP(NETIF_MSG_LINK
, "Setting KR 20G-Force\n");
4517 bnx2x_warpcore_set_20G_force_KR2(phy
, params
);
4522 "Unsupported Serdes Net Interface 0x%x\n",
4528 /* Take lane out of reset after configuration is finished */
4529 bnx2x_warpcore_reset_lane(bp
, phy
, 0);
4530 DP(NETIF_MSG_LINK
, "Exit config init\n");
4533 static void bnx2x_warpcore_link_reset(struct bnx2x_phy
*phy
,
4534 struct link_params
*params
)
4536 struct bnx2x
*bp
= params
->bp
;
4538 bnx2x_sfp_e3_set_transmitter(params
, phy
, 0);
4539 bnx2x_set_mdio_emac_per_phy(bp
, params
);
4540 bnx2x_set_aer_mmd(params
, phy
);
4541 /* Global register */
4542 bnx2x_warpcore_reset_lane(bp
, phy
, 1);
4544 /* Clear loopback settings (if any) */
4546 bnx2x_cl45_read_and_write(bp
, phy
, MDIO_WC_DEVAD
,
4547 MDIO_WC_REG_COMBO_IEEE0_MIICTRL
, 0xBFFF);
4549 bnx2x_cl45_read_and_write(bp
, phy
, MDIO_WC_DEVAD
,
4550 MDIO_WC_REG_IEEE0BLK_MIICNTL
, 0xfffe);
4552 /* Update those 1-copy registers */
4553 CL22_WR_OVER_CL45(bp
, phy
, MDIO_REG_BANK_AER_BLOCK
,
4554 MDIO_AER_BLOCK_AER_REG
, 0);
4555 /* Enable 1G MDIO (1-copy) */
4556 bnx2x_cl45_read_and_write(bp
, phy
, MDIO_WC_DEVAD
,
4557 MDIO_WC_REG_XGXSBLK0_XGXSCONTROL
,
4560 bnx2x_cl45_read_and_write(bp
, phy
, MDIO_WC_DEVAD
,
4561 MDIO_WC_REG_XGXSBLK1_LANECTRL2
, 0xff00);
4562 lane
= bnx2x_get_warpcore_lane(phy
, params
);
4563 /* Disable CL36 PCS Tx */
4564 bnx2x_cl45_read(bp
, phy
, MDIO_WC_DEVAD
,
4565 MDIO_WC_REG_XGXSBLK1_LANECTRL0
, &val16
);
4566 val16
|= (0x11 << lane
);
4567 if (phy
->flags
& FLAGS_WC_DUAL_MODE
)
4568 val16
|= (0x22 << lane
);
4569 bnx2x_cl45_write(bp
, phy
, MDIO_WC_DEVAD
,
4570 MDIO_WC_REG_XGXSBLK1_LANECTRL0
, val16
);
4572 bnx2x_cl45_read(bp
, phy
, MDIO_WC_DEVAD
,
4573 MDIO_WC_REG_XGXSBLK1_LANECTRL1
, &val16
);
4574 val16
&= ~(0x0303 << (lane
<< 1));
4575 val16
|= (0x0101 << (lane
<< 1));
4576 if (phy
->flags
& FLAGS_WC_DUAL_MODE
) {
4577 val16
&= ~(0x0c0c << (lane
<< 1));
4578 val16
|= (0x0404 << (lane
<< 1));
4581 bnx2x_cl45_write(bp
, phy
, MDIO_WC_DEVAD
,
4582 MDIO_WC_REG_XGXSBLK1_LANECTRL1
, val16
);
4584 bnx2x_set_aer_mmd(params
, phy
);
4588 static void bnx2x_set_warpcore_loopback(struct bnx2x_phy
*phy
,
4589 struct link_params
*params
)
4591 struct bnx2x
*bp
= params
->bp
;
4594 DP(NETIF_MSG_LINK
, "Setting Warpcore loopback type %x, speed %d\n",
4595 params
->loopback_mode
, phy
->req_line_speed
);
4597 if (phy
->req_line_speed
< SPEED_10000
||
4598 phy
->supported
& SUPPORTED_20000baseKR2_Full
) {
4599 /* 10/100/1000/20G-KR2 */
4601 /* Update those 1-copy registers */
4602 CL22_WR_OVER_CL45(bp
, phy
, MDIO_REG_BANK_AER_BLOCK
,
4603 MDIO_AER_BLOCK_AER_REG
, 0);
4604 /* Enable 1G MDIO (1-copy) */
4605 bnx2x_cl45_read_or_write(bp
, phy
, MDIO_WC_DEVAD
,
4606 MDIO_WC_REG_XGXSBLK0_XGXSCONTROL
,
4608 /* Set 1G loopback based on lane (1-copy) */
4609 lane
= bnx2x_get_warpcore_lane(phy
, params
);
4610 bnx2x_cl45_read(bp
, phy
, MDIO_WC_DEVAD
,
4611 MDIO_WC_REG_XGXSBLK1_LANECTRL2
, &val16
);
4613 if (phy
->flags
& FLAGS_WC_DUAL_MODE
)
4615 bnx2x_cl45_write(bp
, phy
, MDIO_WC_DEVAD
,
4616 MDIO_WC_REG_XGXSBLK1_LANECTRL2
,
4619 /* Switch back to 4-copy registers */
4620 bnx2x_set_aer_mmd(params
, phy
);
4622 /* 10G / 20G-DXGXS */
4623 bnx2x_cl45_read_or_write(bp
, phy
, MDIO_WC_DEVAD
,
4624 MDIO_WC_REG_COMBO_IEEE0_MIICTRL
,
4626 bnx2x_cl45_read_or_write(bp
, phy
, MDIO_WC_DEVAD
,
4627 MDIO_WC_REG_IEEE0BLK_MIICNTL
, 0x1);
4633 static void bnx2x_sync_link(struct link_params
*params
,
4634 struct link_vars
*vars
)
4636 struct bnx2x
*bp
= params
->bp
;
4638 if (vars
->link_status
& LINK_STATUS_PHYSICAL_LINK_FLAG
)
4639 vars
->phy_flags
|= PHY_PHYSICAL_LINK_FLAG
;
4640 vars
->link_up
= (vars
->link_status
& LINK_STATUS_LINK_UP
);
4641 if (vars
->link_up
) {
4642 DP(NETIF_MSG_LINK
, "phy link up\n");
4644 vars
->phy_link_up
= 1;
4645 vars
->duplex
= DUPLEX_FULL
;
4646 switch (vars
->link_status
&
4647 LINK_STATUS_SPEED_AND_DUPLEX_MASK
) {
4649 vars
->duplex
= DUPLEX_HALF
;
4652 vars
->line_speed
= SPEED_10
;
4656 vars
->duplex
= DUPLEX_HALF
;
4660 vars
->line_speed
= SPEED_100
;
4664 vars
->duplex
= DUPLEX_HALF
;
4667 vars
->line_speed
= SPEED_1000
;
4671 vars
->duplex
= DUPLEX_HALF
;
4674 vars
->line_speed
= SPEED_2500
;
4678 vars
->line_speed
= SPEED_10000
;
4681 vars
->line_speed
= SPEED_20000
;
4686 vars
->flow_ctrl
= 0;
4687 if (vars
->link_status
& LINK_STATUS_TX_FLOW_CONTROL_ENABLED
)
4688 vars
->flow_ctrl
|= BNX2X_FLOW_CTRL_TX
;
4690 if (vars
->link_status
& LINK_STATUS_RX_FLOW_CONTROL_ENABLED
)
4691 vars
->flow_ctrl
|= BNX2X_FLOW_CTRL_RX
;
4693 if (!vars
->flow_ctrl
)
4694 vars
->flow_ctrl
= BNX2X_FLOW_CTRL_NONE
;
4696 if (vars
->line_speed
&&
4697 ((vars
->line_speed
== SPEED_10
) ||
4698 (vars
->line_speed
== SPEED_100
))) {
4699 vars
->phy_flags
|= PHY_SGMII_FLAG
;
4701 vars
->phy_flags
&= ~PHY_SGMII_FLAG
;
4703 if (vars
->line_speed
&&
4704 USES_WARPCORE(bp
) &&
4705 (vars
->line_speed
== SPEED_1000
))
4706 vars
->phy_flags
|= PHY_SGMII_FLAG
;
4707 /* Anything 10 and over uses the bmac */
4708 link_10g_plus
= (vars
->line_speed
>= SPEED_10000
);
4710 if (link_10g_plus
) {
4711 if (USES_WARPCORE(bp
))
4712 vars
->mac_type
= MAC_TYPE_XMAC
;
4714 vars
->mac_type
= MAC_TYPE_BMAC
;
4716 if (USES_WARPCORE(bp
))
4717 vars
->mac_type
= MAC_TYPE_UMAC
;
4719 vars
->mac_type
= MAC_TYPE_EMAC
;
4721 } else { /* Link down */
4722 DP(NETIF_MSG_LINK
, "phy link down\n");
4724 vars
->phy_link_up
= 0;
4726 vars
->line_speed
= 0;
4727 vars
->duplex
= DUPLEX_FULL
;
4728 vars
->flow_ctrl
= BNX2X_FLOW_CTRL_NONE
;
4730 /* Indicate no mac active */
4731 vars
->mac_type
= MAC_TYPE_NONE
;
4732 if (vars
->link_status
& LINK_STATUS_PHYSICAL_LINK_FLAG
)
4733 vars
->phy_flags
|= PHY_HALF_OPEN_CONN_FLAG
;
4734 if (vars
->link_status
& LINK_STATUS_SFP_TX_FAULT
)
4735 vars
->phy_flags
|= PHY_SFP_TX_FAULT_FLAG
;
4739 void bnx2x_link_status_update(struct link_params
*params
,
4740 struct link_vars
*vars
)
4742 struct bnx2x
*bp
= params
->bp
;
4743 u8 port
= params
->port
;
4744 u32 sync_offset
, media_types
;
4745 /* Update PHY configuration */
4746 set_phy_vars(params
, vars
);
4748 vars
->link_status
= REG_RD(bp
, params
->shmem_base
+
4749 offsetof(struct shmem_region
,
4750 port_mb
[port
].link_status
));
4752 /* Force link UP in non LOOPBACK_EXT loopback mode(s) */
4753 if (bp
->link_params
.loopback_mode
!= LOOPBACK_NONE
&&
4754 bp
->link_params
.loopback_mode
!= LOOPBACK_EXT
)
4755 vars
->link_status
|= LINK_STATUS_LINK_UP
;
4757 if (bnx2x_eee_has_cap(params
))
4758 vars
->eee_status
= REG_RD(bp
, params
->shmem2_base
+
4759 offsetof(struct shmem2_region
,
4760 eee_status
[params
->port
]));
4762 vars
->phy_flags
= PHY_XGXS_FLAG
;
4763 bnx2x_sync_link(params
, vars
);
4764 /* Sync media type */
4765 sync_offset
= params
->shmem_base
+
4766 offsetof(struct shmem_region
,
4767 dev_info
.port_hw_config
[port
].media_type
);
4768 media_types
= REG_RD(bp
, sync_offset
);
4770 params
->phy
[INT_PHY
].media_type
=
4771 (media_types
& PORT_HW_CFG_MEDIA_TYPE_PHY0_MASK
) >>
4772 PORT_HW_CFG_MEDIA_TYPE_PHY0_SHIFT
;
4773 params
->phy
[EXT_PHY1
].media_type
=
4774 (media_types
& PORT_HW_CFG_MEDIA_TYPE_PHY1_MASK
) >>
4775 PORT_HW_CFG_MEDIA_TYPE_PHY1_SHIFT
;
4776 params
->phy
[EXT_PHY2
].media_type
=
4777 (media_types
& PORT_HW_CFG_MEDIA_TYPE_PHY2_MASK
) >>
4778 PORT_HW_CFG_MEDIA_TYPE_PHY2_SHIFT
;
4779 DP(NETIF_MSG_LINK
, "media_types = 0x%x\n", media_types
);
4781 /* Sync AEU offset */
4782 sync_offset
= params
->shmem_base
+
4783 offsetof(struct shmem_region
,
4784 dev_info
.port_hw_config
[port
].aeu_int_mask
);
4786 vars
->aeu_int_mask
= REG_RD(bp
, sync_offset
);
4788 /* Sync PFC status */
4789 if (vars
->link_status
& LINK_STATUS_PFC_ENABLED
)
4790 params
->feature_config_flags
|=
4791 FEATURE_CONFIG_PFC_ENABLED
;
4793 params
->feature_config_flags
&=
4794 ~FEATURE_CONFIG_PFC_ENABLED
;
4796 if (SHMEM2_HAS(bp
, link_attr_sync
))
4797 vars
->link_attr_sync
= SHMEM2_RD(bp
,
4798 link_attr_sync
[params
->port
]);
4800 DP(NETIF_MSG_LINK
, "link_status 0x%x phy_link_up %x int_mask 0x%x\n",
4801 vars
->link_status
, vars
->phy_link_up
, vars
->aeu_int_mask
);
4802 DP(NETIF_MSG_LINK
, "line_speed %x duplex %x flow_ctrl 0x%x\n",
4803 vars
->line_speed
, vars
->duplex
, vars
->flow_ctrl
);
4806 static void bnx2x_set_master_ln(struct link_params
*params
,
4807 struct bnx2x_phy
*phy
)
4809 struct bnx2x
*bp
= params
->bp
;
4810 u16 new_master_ln
, ser_lane
;
4811 ser_lane
= ((params
->lane_config
&
4812 PORT_HW_CFG_LANE_SWAP_CFG_MASTER_MASK
) >>
4813 PORT_HW_CFG_LANE_SWAP_CFG_MASTER_SHIFT
);
4815 /* Set the master_ln for AN */
4816 CL22_RD_OVER_CL45(bp
, phy
,
4817 MDIO_REG_BANK_XGXS_BLOCK2
,
4818 MDIO_XGXS_BLOCK2_TEST_MODE_LANE
,
4821 CL22_WR_OVER_CL45(bp
, phy
,
4822 MDIO_REG_BANK_XGXS_BLOCK2
,
4823 MDIO_XGXS_BLOCK2_TEST_MODE_LANE
,
4824 (new_master_ln
| ser_lane
));
4827 static int bnx2x_reset_unicore(struct link_params
*params
,
4828 struct bnx2x_phy
*phy
,
4831 struct bnx2x
*bp
= params
->bp
;
4834 CL22_RD_OVER_CL45(bp
, phy
,
4835 MDIO_REG_BANK_COMBO_IEEE0
,
4836 MDIO_COMBO_IEEE0_MII_CONTROL
, &mii_control
);
4838 /* Reset the unicore */
4839 CL22_WR_OVER_CL45(bp
, phy
,
4840 MDIO_REG_BANK_COMBO_IEEE0
,
4841 MDIO_COMBO_IEEE0_MII_CONTROL
,
4843 MDIO_COMBO_IEEO_MII_CONTROL_RESET
));
4845 bnx2x_set_serdes_access(bp
, params
->port
);
4847 /* Wait for the reset to self clear */
4848 for (i
= 0; i
< MDIO_ACCESS_TIMEOUT
; i
++) {
4851 /* The reset erased the previous bank value */
4852 CL22_RD_OVER_CL45(bp
, phy
,
4853 MDIO_REG_BANK_COMBO_IEEE0
,
4854 MDIO_COMBO_IEEE0_MII_CONTROL
,
4857 if (!(mii_control
& MDIO_COMBO_IEEO_MII_CONTROL_RESET
)) {
4863 netdev_err(bp
->dev
, "Warning: PHY was not initialized,"
4866 DP(NETIF_MSG_LINK
, "BUG! XGXS is still in reset!\n");
4871 static void bnx2x_set_swap_lanes(struct link_params
*params
,
4872 struct bnx2x_phy
*phy
)
4874 struct bnx2x
*bp
= params
->bp
;
4875 /* Each two bits represents a lane number:
4876 * No swap is 0123 => 0x1b no need to enable the swap
4878 u16 rx_lane_swap
, tx_lane_swap
;
4880 rx_lane_swap
= ((params
->lane_config
&
4881 PORT_HW_CFG_LANE_SWAP_CFG_RX_MASK
) >>
4882 PORT_HW_CFG_LANE_SWAP_CFG_RX_SHIFT
);
4883 tx_lane_swap
= ((params
->lane_config
&
4884 PORT_HW_CFG_LANE_SWAP_CFG_TX_MASK
) >>
4885 PORT_HW_CFG_LANE_SWAP_CFG_TX_SHIFT
);
4887 if (rx_lane_swap
!= 0x1b) {
4888 CL22_WR_OVER_CL45(bp
, phy
,
4889 MDIO_REG_BANK_XGXS_BLOCK2
,
4890 MDIO_XGXS_BLOCK2_RX_LN_SWAP
,
4892 MDIO_XGXS_BLOCK2_RX_LN_SWAP_ENABLE
|
4893 MDIO_XGXS_BLOCK2_RX_LN_SWAP_FORCE_ENABLE
));
4895 CL22_WR_OVER_CL45(bp
, phy
,
4896 MDIO_REG_BANK_XGXS_BLOCK2
,
4897 MDIO_XGXS_BLOCK2_RX_LN_SWAP
, 0);
4900 if (tx_lane_swap
!= 0x1b) {
4901 CL22_WR_OVER_CL45(bp
, phy
,
4902 MDIO_REG_BANK_XGXS_BLOCK2
,
4903 MDIO_XGXS_BLOCK2_TX_LN_SWAP
,
4905 MDIO_XGXS_BLOCK2_TX_LN_SWAP_ENABLE
));
4907 CL22_WR_OVER_CL45(bp
, phy
,
4908 MDIO_REG_BANK_XGXS_BLOCK2
,
4909 MDIO_XGXS_BLOCK2_TX_LN_SWAP
, 0);
4913 static void bnx2x_set_parallel_detection(struct bnx2x_phy
*phy
,
4914 struct link_params
*params
)
4916 struct bnx2x
*bp
= params
->bp
;
4918 CL22_RD_OVER_CL45(bp
, phy
,
4919 MDIO_REG_BANK_SERDES_DIGITAL
,
4920 MDIO_SERDES_DIGITAL_A_1000X_CONTROL2
,
4922 if (phy
->speed_cap_mask
& PORT_HW_CFG_SPEED_CAPABILITY_D0_1G
)
4923 control2
|= MDIO_SERDES_DIGITAL_A_1000X_CONTROL2_PRL_DT_EN
;
4925 control2
&= ~MDIO_SERDES_DIGITAL_A_1000X_CONTROL2_PRL_DT_EN
;
4926 DP(NETIF_MSG_LINK
, "phy->speed_cap_mask = 0x%x, control2 = 0x%x\n",
4927 phy
->speed_cap_mask
, control2
);
4928 CL22_WR_OVER_CL45(bp
, phy
,
4929 MDIO_REG_BANK_SERDES_DIGITAL
,
4930 MDIO_SERDES_DIGITAL_A_1000X_CONTROL2
,
4933 if ((phy
->type
== PORT_HW_CFG_XGXS_EXT_PHY_TYPE_DIRECT
) &&
4934 (phy
->speed_cap_mask
&
4935 PORT_HW_CFG_SPEED_CAPABILITY_D0_10G
)) {
4936 DP(NETIF_MSG_LINK
, "XGXS\n");
4938 CL22_WR_OVER_CL45(bp
, phy
,
4939 MDIO_REG_BANK_10G_PARALLEL_DETECT
,
4940 MDIO_10G_PARALLEL_DETECT_PAR_DET_10G_LINK
,
4941 MDIO_10G_PARALLEL_DETECT_PAR_DET_10G_LINK_CNT
);
4943 CL22_RD_OVER_CL45(bp
, phy
,
4944 MDIO_REG_BANK_10G_PARALLEL_DETECT
,
4945 MDIO_10G_PARALLEL_DETECT_PAR_DET_10G_CONTROL
,
4950 MDIO_10G_PARALLEL_DETECT_PAR_DET_10G_CONTROL_PARDET10G_EN
;
4952 CL22_WR_OVER_CL45(bp
, phy
,
4953 MDIO_REG_BANK_10G_PARALLEL_DETECT
,
4954 MDIO_10G_PARALLEL_DETECT_PAR_DET_10G_CONTROL
,
4957 /* Disable parallel detection of HiG */
4958 CL22_WR_OVER_CL45(bp
, phy
,
4959 MDIO_REG_BANK_XGXS_BLOCK2
,
4960 MDIO_XGXS_BLOCK2_UNICORE_MODE_10G
,
4961 MDIO_XGXS_BLOCK2_UNICORE_MODE_10G_CX4_XGXS
|
4962 MDIO_XGXS_BLOCK2_UNICORE_MODE_10G_HIGIG_XGXS
);
4966 static void bnx2x_set_autoneg(struct bnx2x_phy
*phy
,
4967 struct link_params
*params
,
4968 struct link_vars
*vars
,
4971 struct bnx2x
*bp
= params
->bp
;
4975 CL22_RD_OVER_CL45(bp
, phy
,
4976 MDIO_REG_BANK_COMBO_IEEE0
,
4977 MDIO_COMBO_IEEE0_MII_CONTROL
, ®_val
);
4979 /* CL37 Autoneg Enabled */
4980 if (vars
->line_speed
== SPEED_AUTO_NEG
)
4981 reg_val
|= MDIO_COMBO_IEEO_MII_CONTROL_AN_EN
;
4982 else /* CL37 Autoneg Disabled */
4983 reg_val
&= ~(MDIO_COMBO_IEEO_MII_CONTROL_AN_EN
|
4984 MDIO_COMBO_IEEO_MII_CONTROL_RESTART_AN
);
4986 CL22_WR_OVER_CL45(bp
, phy
,
4987 MDIO_REG_BANK_COMBO_IEEE0
,
4988 MDIO_COMBO_IEEE0_MII_CONTROL
, reg_val
);
4990 /* Enable/Disable Autodetection */
4992 CL22_RD_OVER_CL45(bp
, phy
,
4993 MDIO_REG_BANK_SERDES_DIGITAL
,
4994 MDIO_SERDES_DIGITAL_A_1000X_CONTROL1
, ®_val
);
4995 reg_val
&= ~(MDIO_SERDES_DIGITAL_A_1000X_CONTROL1_SIGNAL_DETECT_EN
|
4996 MDIO_SERDES_DIGITAL_A_1000X_CONTROL1_INVERT_SIGNAL_DETECT
);
4997 reg_val
|= MDIO_SERDES_DIGITAL_A_1000X_CONTROL1_FIBER_MODE
;
4998 if (vars
->line_speed
== SPEED_AUTO_NEG
)
4999 reg_val
|= MDIO_SERDES_DIGITAL_A_1000X_CONTROL1_AUTODET
;
5001 reg_val
&= ~MDIO_SERDES_DIGITAL_A_1000X_CONTROL1_AUTODET
;
5003 CL22_WR_OVER_CL45(bp
, phy
,
5004 MDIO_REG_BANK_SERDES_DIGITAL
,
5005 MDIO_SERDES_DIGITAL_A_1000X_CONTROL1
, reg_val
);
5007 /* Enable TetonII and BAM autoneg */
5008 CL22_RD_OVER_CL45(bp
, phy
,
5009 MDIO_REG_BANK_BAM_NEXT_PAGE
,
5010 MDIO_BAM_NEXT_PAGE_MP5_NEXT_PAGE_CTRL
,
5012 if (vars
->line_speed
== SPEED_AUTO_NEG
) {
5013 /* Enable BAM aneg Mode and TetonII aneg Mode */
5014 reg_val
|= (MDIO_BAM_NEXT_PAGE_MP5_NEXT_PAGE_CTRL_BAM_MODE
|
5015 MDIO_BAM_NEXT_PAGE_MP5_NEXT_PAGE_CTRL_TETON_AN
);
5017 /* TetonII and BAM Autoneg Disabled */
5018 reg_val
&= ~(MDIO_BAM_NEXT_PAGE_MP5_NEXT_PAGE_CTRL_BAM_MODE
|
5019 MDIO_BAM_NEXT_PAGE_MP5_NEXT_PAGE_CTRL_TETON_AN
);
5021 CL22_WR_OVER_CL45(bp
, phy
,
5022 MDIO_REG_BANK_BAM_NEXT_PAGE
,
5023 MDIO_BAM_NEXT_PAGE_MP5_NEXT_PAGE_CTRL
,
5027 /* Enable Cl73 FSM status bits */
5028 CL22_WR_OVER_CL45(bp
, phy
,
5029 MDIO_REG_BANK_CL73_USERB0
,
5030 MDIO_CL73_USERB0_CL73_UCTRL
,
5033 /* Enable BAM Station Manager*/
5034 CL22_WR_OVER_CL45(bp
, phy
,
5035 MDIO_REG_BANK_CL73_USERB0
,
5036 MDIO_CL73_USERB0_CL73_BAM_CTRL1
,
5037 MDIO_CL73_USERB0_CL73_BAM_CTRL1_BAM_EN
|
5038 MDIO_CL73_USERB0_CL73_BAM_CTRL1_BAM_STATION_MNGR_EN
|
5039 MDIO_CL73_USERB0_CL73_BAM_CTRL1_BAM_NP_AFTER_BP_EN
);
5041 /* Advertise CL73 link speeds */
5042 CL22_RD_OVER_CL45(bp
, phy
,
5043 MDIO_REG_BANK_CL73_IEEEB1
,
5044 MDIO_CL73_IEEEB1_AN_ADV2
,
5046 if (phy
->speed_cap_mask
&
5047 PORT_HW_CFG_SPEED_CAPABILITY_D0_10G
)
5048 reg_val
|= MDIO_CL73_IEEEB1_AN_ADV2_ADVR_10G_KX4
;
5049 if (phy
->speed_cap_mask
&
5050 PORT_HW_CFG_SPEED_CAPABILITY_D0_1G
)
5051 reg_val
|= MDIO_CL73_IEEEB1_AN_ADV2_ADVR_1000M_KX
;
5053 CL22_WR_OVER_CL45(bp
, phy
,
5054 MDIO_REG_BANK_CL73_IEEEB1
,
5055 MDIO_CL73_IEEEB1_AN_ADV2
,
5058 /* CL73 Autoneg Enabled */
5059 reg_val
= MDIO_CL73_IEEEB0_CL73_AN_CONTROL_AN_EN
;
5061 } else /* CL73 Autoneg Disabled */
5064 CL22_WR_OVER_CL45(bp
, phy
,
5065 MDIO_REG_BANK_CL73_IEEEB0
,
5066 MDIO_CL73_IEEEB0_CL73_AN_CONTROL
, reg_val
);
5069 /* Program SerDes, forced speed */
5070 static void bnx2x_program_serdes(struct bnx2x_phy
*phy
,
5071 struct link_params
*params
,
5072 struct link_vars
*vars
)
5074 struct bnx2x
*bp
= params
->bp
;
5077 /* Program duplex, disable autoneg and sgmii*/
5078 CL22_RD_OVER_CL45(bp
, phy
,
5079 MDIO_REG_BANK_COMBO_IEEE0
,
5080 MDIO_COMBO_IEEE0_MII_CONTROL
, ®_val
);
5081 reg_val
&= ~(MDIO_COMBO_IEEO_MII_CONTROL_FULL_DUPLEX
|
5082 MDIO_COMBO_IEEO_MII_CONTROL_AN_EN
|
5083 MDIO_COMBO_IEEO_MII_CONTROL_MAN_SGMII_SP_MASK
);
5084 if (phy
->req_duplex
== DUPLEX_FULL
)
5085 reg_val
|= MDIO_COMBO_IEEO_MII_CONTROL_FULL_DUPLEX
;
5086 CL22_WR_OVER_CL45(bp
, phy
,
5087 MDIO_REG_BANK_COMBO_IEEE0
,
5088 MDIO_COMBO_IEEE0_MII_CONTROL
, reg_val
);
5091 * - needed only if the speed is greater than 1G (2.5G or 10G)
5093 CL22_RD_OVER_CL45(bp
, phy
,
5094 MDIO_REG_BANK_SERDES_DIGITAL
,
5095 MDIO_SERDES_DIGITAL_MISC1
, ®_val
);
5096 /* Clearing the speed value before setting the right speed */
5097 DP(NETIF_MSG_LINK
, "MDIO_REG_BANK_SERDES_DIGITAL = 0x%x\n", reg_val
);
5099 reg_val
&= ~(MDIO_SERDES_DIGITAL_MISC1_FORCE_SPEED_MASK
|
5100 MDIO_SERDES_DIGITAL_MISC1_FORCE_SPEED_SEL
);
5102 if (!((vars
->line_speed
== SPEED_1000
) ||
5103 (vars
->line_speed
== SPEED_100
) ||
5104 (vars
->line_speed
== SPEED_10
))) {
5106 reg_val
|= (MDIO_SERDES_DIGITAL_MISC1_REFCLK_SEL_156_25M
|
5107 MDIO_SERDES_DIGITAL_MISC1_FORCE_SPEED_SEL
);
5108 if (vars
->line_speed
== SPEED_10000
)
5110 MDIO_SERDES_DIGITAL_MISC1_FORCE_SPEED_10G_CX4
;
5113 CL22_WR_OVER_CL45(bp
, phy
,
5114 MDIO_REG_BANK_SERDES_DIGITAL
,
5115 MDIO_SERDES_DIGITAL_MISC1
, reg_val
);
5119 static void bnx2x_set_brcm_cl37_advertisement(struct bnx2x_phy
*phy
,
5120 struct link_params
*params
)
5122 struct bnx2x
*bp
= params
->bp
;
5125 /* Set extended capabilities */
5126 if (phy
->speed_cap_mask
& PORT_HW_CFG_SPEED_CAPABILITY_D0_2_5G
)
5127 val
|= MDIO_OVER_1G_UP1_2_5G
;
5128 if (phy
->speed_cap_mask
& PORT_HW_CFG_SPEED_CAPABILITY_D0_10G
)
5129 val
|= MDIO_OVER_1G_UP1_10G
;
5130 CL22_WR_OVER_CL45(bp
, phy
,
5131 MDIO_REG_BANK_OVER_1G
,
5132 MDIO_OVER_1G_UP1
, val
);
5134 CL22_WR_OVER_CL45(bp
, phy
,
5135 MDIO_REG_BANK_OVER_1G
,
5136 MDIO_OVER_1G_UP3
, 0x400);
5139 static void bnx2x_set_ieee_aneg_advertisement(struct bnx2x_phy
*phy
,
5140 struct link_params
*params
,
5143 struct bnx2x
*bp
= params
->bp
;
5145 /* For AN, we are always publishing full duplex */
5147 CL22_WR_OVER_CL45(bp
, phy
,
5148 MDIO_REG_BANK_COMBO_IEEE0
,
5149 MDIO_COMBO_IEEE0_AUTO_NEG_ADV
, ieee_fc
);
5150 CL22_RD_OVER_CL45(bp
, phy
,
5151 MDIO_REG_BANK_CL73_IEEEB1
,
5152 MDIO_CL73_IEEEB1_AN_ADV1
, &val
);
5153 val
&= ~MDIO_CL73_IEEEB1_AN_ADV1_PAUSE_BOTH
;
5154 val
|= ((ieee_fc
<<3) & MDIO_CL73_IEEEB1_AN_ADV1_PAUSE_MASK
);
5155 CL22_WR_OVER_CL45(bp
, phy
,
5156 MDIO_REG_BANK_CL73_IEEEB1
,
5157 MDIO_CL73_IEEEB1_AN_ADV1
, val
);
5160 static void bnx2x_restart_autoneg(struct bnx2x_phy
*phy
,
5161 struct link_params
*params
,
5164 struct bnx2x
*bp
= params
->bp
;
5167 DP(NETIF_MSG_LINK
, "bnx2x_restart_autoneg\n");
5168 /* Enable and restart BAM/CL37 aneg */
5171 CL22_RD_OVER_CL45(bp
, phy
,
5172 MDIO_REG_BANK_CL73_IEEEB0
,
5173 MDIO_CL73_IEEEB0_CL73_AN_CONTROL
,
5176 CL22_WR_OVER_CL45(bp
, phy
,
5177 MDIO_REG_BANK_CL73_IEEEB0
,
5178 MDIO_CL73_IEEEB0_CL73_AN_CONTROL
,
5180 MDIO_CL73_IEEEB0_CL73_AN_CONTROL_AN_EN
|
5181 MDIO_CL73_IEEEB0_CL73_AN_CONTROL_RESTART_AN
));
5184 CL22_RD_OVER_CL45(bp
, phy
,
5185 MDIO_REG_BANK_COMBO_IEEE0
,
5186 MDIO_COMBO_IEEE0_MII_CONTROL
,
5189 "bnx2x_restart_autoneg mii_control before = 0x%x\n",
5191 CL22_WR_OVER_CL45(bp
, phy
,
5192 MDIO_REG_BANK_COMBO_IEEE0
,
5193 MDIO_COMBO_IEEE0_MII_CONTROL
,
5195 MDIO_COMBO_IEEO_MII_CONTROL_AN_EN
|
5196 MDIO_COMBO_IEEO_MII_CONTROL_RESTART_AN
));
5200 static void bnx2x_initialize_sgmii_process(struct bnx2x_phy
*phy
,
5201 struct link_params
*params
,
5202 struct link_vars
*vars
)
5204 struct bnx2x
*bp
= params
->bp
;
5207 /* In SGMII mode, the unicore is always slave */
5209 CL22_RD_OVER_CL45(bp
, phy
,
5210 MDIO_REG_BANK_SERDES_DIGITAL
,
5211 MDIO_SERDES_DIGITAL_A_1000X_CONTROL1
,
5213 control1
|= MDIO_SERDES_DIGITAL_A_1000X_CONTROL1_INVERT_SIGNAL_DETECT
;
5214 /* Set sgmii mode (and not fiber) */
5215 control1
&= ~(MDIO_SERDES_DIGITAL_A_1000X_CONTROL1_FIBER_MODE
|
5216 MDIO_SERDES_DIGITAL_A_1000X_CONTROL1_AUTODET
|
5217 MDIO_SERDES_DIGITAL_A_1000X_CONTROL1_MSTR_MODE
);
5218 CL22_WR_OVER_CL45(bp
, phy
,
5219 MDIO_REG_BANK_SERDES_DIGITAL
,
5220 MDIO_SERDES_DIGITAL_A_1000X_CONTROL1
,
5223 /* If forced speed */
5224 if (!(vars
->line_speed
== SPEED_AUTO_NEG
)) {
5225 /* Set speed, disable autoneg */
5228 CL22_RD_OVER_CL45(bp
, phy
,
5229 MDIO_REG_BANK_COMBO_IEEE0
,
5230 MDIO_COMBO_IEEE0_MII_CONTROL
,
5232 mii_control
&= ~(MDIO_COMBO_IEEO_MII_CONTROL_AN_EN
|
5233 MDIO_COMBO_IEEO_MII_CONTROL_MAN_SGMII_SP_MASK
|
5234 MDIO_COMBO_IEEO_MII_CONTROL_FULL_DUPLEX
);
5236 switch (vars
->line_speed
) {
5239 MDIO_COMBO_IEEO_MII_CONTROL_MAN_SGMII_SP_100
;
5243 MDIO_COMBO_IEEO_MII_CONTROL_MAN_SGMII_SP_1000
;
5246 /* There is nothing to set for 10M */
5249 /* Invalid speed for SGMII */
5250 DP(NETIF_MSG_LINK
, "Invalid line_speed 0x%x\n",
5255 /* Setting the full duplex */
5256 if (phy
->req_duplex
== DUPLEX_FULL
)
5258 MDIO_COMBO_IEEO_MII_CONTROL_FULL_DUPLEX
;
5259 CL22_WR_OVER_CL45(bp
, phy
,
5260 MDIO_REG_BANK_COMBO_IEEE0
,
5261 MDIO_COMBO_IEEE0_MII_CONTROL
,
5264 } else { /* AN mode */
5265 /* Enable and restart AN */
5266 bnx2x_restart_autoneg(phy
, params
, 0);
5272 static int bnx2x_direct_parallel_detect_used(struct bnx2x_phy
*phy
,
5273 struct link_params
*params
)
5275 struct bnx2x
*bp
= params
->bp
;
5276 u16 pd_10g
, status2_1000x
;
5277 if (phy
->req_line_speed
!= SPEED_AUTO_NEG
)
5279 CL22_RD_OVER_CL45(bp
, phy
,
5280 MDIO_REG_BANK_SERDES_DIGITAL
,
5281 MDIO_SERDES_DIGITAL_A_1000X_STATUS2
,
5283 CL22_RD_OVER_CL45(bp
, phy
,
5284 MDIO_REG_BANK_SERDES_DIGITAL
,
5285 MDIO_SERDES_DIGITAL_A_1000X_STATUS2
,
5287 if (status2_1000x
& MDIO_SERDES_DIGITAL_A_1000X_STATUS2_AN_DISABLED
) {
5288 DP(NETIF_MSG_LINK
, "1G parallel detect link on port %d\n",
5293 CL22_RD_OVER_CL45(bp
, phy
,
5294 MDIO_REG_BANK_10G_PARALLEL_DETECT
,
5295 MDIO_10G_PARALLEL_DETECT_PAR_DET_10G_STATUS
,
5298 if (pd_10g
& MDIO_10G_PARALLEL_DETECT_PAR_DET_10G_STATUS_PD_LINK
) {
5299 DP(NETIF_MSG_LINK
, "10G parallel detect link on port %d\n",
5306 static void bnx2x_update_adv_fc(struct bnx2x_phy
*phy
,
5307 struct link_params
*params
,
5308 struct link_vars
*vars
,
5311 u16 ld_pause
; /* local driver */
5312 u16 lp_pause
; /* link partner */
5314 struct bnx2x
*bp
= params
->bp
;
5316 (MDIO_GP_STATUS_TOP_AN_STATUS1_CL73_AUTONEG_COMPLETE
|
5317 MDIO_GP_STATUS_TOP_AN_STATUS1_CL73_MR_LP_NP_AN_ABLE
)) ==
5318 (MDIO_GP_STATUS_TOP_AN_STATUS1_CL73_AUTONEG_COMPLETE
|
5319 MDIO_GP_STATUS_TOP_AN_STATUS1_CL73_MR_LP_NP_AN_ABLE
)) {
5321 CL22_RD_OVER_CL45(bp
, phy
,
5322 MDIO_REG_BANK_CL73_IEEEB1
,
5323 MDIO_CL73_IEEEB1_AN_ADV1
,
5325 CL22_RD_OVER_CL45(bp
, phy
,
5326 MDIO_REG_BANK_CL73_IEEEB1
,
5327 MDIO_CL73_IEEEB1_AN_LP_ADV1
,
5329 pause_result
= (ld_pause
&
5330 MDIO_CL73_IEEEB1_AN_ADV1_PAUSE_MASK
) >> 8;
5331 pause_result
|= (lp_pause
&
5332 MDIO_CL73_IEEEB1_AN_LP_ADV1_PAUSE_MASK
) >> 10;
5333 DP(NETIF_MSG_LINK
, "pause_result CL73 0x%x\n", pause_result
);
5335 CL22_RD_OVER_CL45(bp
, phy
,
5336 MDIO_REG_BANK_COMBO_IEEE0
,
5337 MDIO_COMBO_IEEE0_AUTO_NEG_ADV
,
5339 CL22_RD_OVER_CL45(bp
, phy
,
5340 MDIO_REG_BANK_COMBO_IEEE0
,
5341 MDIO_COMBO_IEEE0_AUTO_NEG_LINK_PARTNER_ABILITY1
,
5343 pause_result
= (ld_pause
&
5344 MDIO_COMBO_IEEE0_AUTO_NEG_ADV_PAUSE_MASK
)>>5;
5345 pause_result
|= (lp_pause
&
5346 MDIO_COMBO_IEEE0_AUTO_NEG_ADV_PAUSE_MASK
)>>7;
5347 DP(NETIF_MSG_LINK
, "pause_result CL37 0x%x\n", pause_result
);
5349 bnx2x_pause_resolve(vars
, pause_result
);
5353 static void bnx2x_flow_ctrl_resolve(struct bnx2x_phy
*phy
,
5354 struct link_params
*params
,
5355 struct link_vars
*vars
,
5358 struct bnx2x
*bp
= params
->bp
;
5359 vars
->flow_ctrl
= BNX2X_FLOW_CTRL_NONE
;
5361 /* Resolve from gp_status in case of AN complete and not sgmii */
5362 if (phy
->req_flow_ctrl
!= BNX2X_FLOW_CTRL_AUTO
) {
5363 /* Update the advertised flow-controled of LD/LP in AN */
5364 if (phy
->req_line_speed
== SPEED_AUTO_NEG
)
5365 bnx2x_update_adv_fc(phy
, params
, vars
, gp_status
);
5366 /* But set the flow-control result as the requested one */
5367 vars
->flow_ctrl
= phy
->req_flow_ctrl
;
5368 } else if (phy
->req_line_speed
!= SPEED_AUTO_NEG
)
5369 vars
->flow_ctrl
= params
->req_fc_auto_adv
;
5370 else if ((gp_status
& MDIO_AN_CL73_OR_37_COMPLETE
) &&
5371 (!(vars
->phy_flags
& PHY_SGMII_FLAG
))) {
5372 if (bnx2x_direct_parallel_detect_used(phy
, params
)) {
5373 vars
->flow_ctrl
= params
->req_fc_auto_adv
;
5376 bnx2x_update_adv_fc(phy
, params
, vars
, gp_status
);
5378 DP(NETIF_MSG_LINK
, "flow_ctrl 0x%x\n", vars
->flow_ctrl
);
5381 static void bnx2x_check_fallback_to_cl37(struct bnx2x_phy
*phy
,
5382 struct link_params
*params
)
5384 struct bnx2x
*bp
= params
->bp
;
5385 u16 rx_status
, ustat_val
, cl37_fsm_received
;
5386 DP(NETIF_MSG_LINK
, "bnx2x_check_fallback_to_cl37\n");
5387 /* Step 1: Make sure signal is detected */
5388 CL22_RD_OVER_CL45(bp
, phy
,
5392 if ((rx_status
& MDIO_RX0_RX_STATUS_SIGDET
) !=
5393 (MDIO_RX0_RX_STATUS_SIGDET
)) {
5394 DP(NETIF_MSG_LINK
, "Signal is not detected. Restoring CL73."
5395 "rx_status(0x80b0) = 0x%x\n", rx_status
);
5396 CL22_WR_OVER_CL45(bp
, phy
,
5397 MDIO_REG_BANK_CL73_IEEEB0
,
5398 MDIO_CL73_IEEEB0_CL73_AN_CONTROL
,
5399 MDIO_CL73_IEEEB0_CL73_AN_CONTROL_AN_EN
);
5402 /* Step 2: Check CL73 state machine */
5403 CL22_RD_OVER_CL45(bp
, phy
,
5404 MDIO_REG_BANK_CL73_USERB0
,
5405 MDIO_CL73_USERB0_CL73_USTAT1
,
5408 (MDIO_CL73_USERB0_CL73_USTAT1_LINK_STATUS_CHECK
|
5409 MDIO_CL73_USERB0_CL73_USTAT1_AN_GOOD_CHECK_BAM37
)) !=
5410 (MDIO_CL73_USERB0_CL73_USTAT1_LINK_STATUS_CHECK
|
5411 MDIO_CL73_USERB0_CL73_USTAT1_AN_GOOD_CHECK_BAM37
)) {
5412 DP(NETIF_MSG_LINK
, "CL73 state-machine is not stable. "
5413 "ustat_val(0x8371) = 0x%x\n", ustat_val
);
5416 /* Step 3: Check CL37 Message Pages received to indicate LP
5417 * supports only CL37
5419 CL22_RD_OVER_CL45(bp
, phy
,
5420 MDIO_REG_BANK_REMOTE_PHY
,
5421 MDIO_REMOTE_PHY_MISC_RX_STATUS
,
5422 &cl37_fsm_received
);
5423 if ((cl37_fsm_received
&
5424 (MDIO_REMOTE_PHY_MISC_RX_STATUS_CL37_FSM_RECEIVED_OVER1G_MSG
|
5425 MDIO_REMOTE_PHY_MISC_RX_STATUS_CL37_FSM_RECEIVED_BRCM_OUI_MSG
)) !=
5426 (MDIO_REMOTE_PHY_MISC_RX_STATUS_CL37_FSM_RECEIVED_OVER1G_MSG
|
5427 MDIO_REMOTE_PHY_MISC_RX_STATUS_CL37_FSM_RECEIVED_BRCM_OUI_MSG
)) {
5428 DP(NETIF_MSG_LINK
, "No CL37 FSM were received. "
5429 "misc_rx_status(0x8330) = 0x%x\n",
5433 /* The combined cl37/cl73 fsm state information indicating that
5434 * we are connected to a device which does not support cl73, but
5435 * does support cl37 BAM. In this case we disable cl73 and
5436 * restart cl37 auto-neg
5440 CL22_WR_OVER_CL45(bp
, phy
,
5441 MDIO_REG_BANK_CL73_IEEEB0
,
5442 MDIO_CL73_IEEEB0_CL73_AN_CONTROL
,
5444 /* Restart CL37 autoneg */
5445 bnx2x_restart_autoneg(phy
, params
, 0);
5446 DP(NETIF_MSG_LINK
, "Disabling CL73, and restarting CL37 autoneg\n");
5449 static void bnx2x_xgxs_an_resolve(struct bnx2x_phy
*phy
,
5450 struct link_params
*params
,
5451 struct link_vars
*vars
,
5454 if (gp_status
& MDIO_AN_CL73_OR_37_COMPLETE
)
5455 vars
->link_status
|=
5456 LINK_STATUS_AUTO_NEGOTIATE_COMPLETE
;
5458 if (bnx2x_direct_parallel_detect_used(phy
, params
))
5459 vars
->link_status
|=
5460 LINK_STATUS_PARALLEL_DETECTION_USED
;
5462 static int bnx2x_get_link_speed_duplex(struct bnx2x_phy
*phy
,
5463 struct link_params
*params
,
5464 struct link_vars
*vars
,
5469 struct bnx2x
*bp
= params
->bp
;
5470 if (phy
->req_line_speed
== SPEED_AUTO_NEG
)
5471 vars
->link_status
|= LINK_STATUS_AUTO_NEGOTIATE_ENABLED
;
5473 DP(NETIF_MSG_LINK
, "phy link up\n");
5475 vars
->phy_link_up
= 1;
5476 vars
->link_status
|= LINK_STATUS_LINK_UP
;
5478 switch (speed_mask
) {
5480 vars
->line_speed
= SPEED_10
;
5481 if (is_duplex
== DUPLEX_FULL
)
5482 vars
->link_status
|= LINK_10TFD
;
5484 vars
->link_status
|= LINK_10THD
;
5487 case GP_STATUS_100M
:
5488 vars
->line_speed
= SPEED_100
;
5489 if (is_duplex
== DUPLEX_FULL
)
5490 vars
->link_status
|= LINK_100TXFD
;
5492 vars
->link_status
|= LINK_100TXHD
;
5496 case GP_STATUS_1G_KX
:
5497 vars
->line_speed
= SPEED_1000
;
5498 if (is_duplex
== DUPLEX_FULL
)
5499 vars
->link_status
|= LINK_1000TFD
;
5501 vars
->link_status
|= LINK_1000THD
;
5504 case GP_STATUS_2_5G
:
5505 vars
->line_speed
= SPEED_2500
;
5506 if (is_duplex
== DUPLEX_FULL
)
5507 vars
->link_status
|= LINK_2500TFD
;
5509 vars
->link_status
|= LINK_2500THD
;
5515 "link speed unsupported gp_status 0x%x\n",
5519 case GP_STATUS_10G_KX4
:
5520 case GP_STATUS_10G_HIG
:
5521 case GP_STATUS_10G_CX4
:
5522 case GP_STATUS_10G_KR
:
5523 case GP_STATUS_10G_SFI
:
5524 case GP_STATUS_10G_XFI
:
5525 vars
->line_speed
= SPEED_10000
;
5526 vars
->link_status
|= LINK_10GTFD
;
5528 case GP_STATUS_20G_DXGXS
:
5529 case GP_STATUS_20G_KR2
:
5530 vars
->line_speed
= SPEED_20000
;
5531 vars
->link_status
|= LINK_20GTFD
;
5535 "link speed unsupported gp_status 0x%x\n",
5539 } else { /* link_down */
5540 DP(NETIF_MSG_LINK
, "phy link down\n");
5542 vars
->phy_link_up
= 0;
5544 vars
->duplex
= DUPLEX_FULL
;
5545 vars
->flow_ctrl
= BNX2X_FLOW_CTRL_NONE
;
5546 vars
->mac_type
= MAC_TYPE_NONE
;
5548 DP(NETIF_MSG_LINK
, " phy_link_up %x line_speed %d\n",
5549 vars
->phy_link_up
, vars
->line_speed
);
5553 static int bnx2x_link_settings_status(struct bnx2x_phy
*phy
,
5554 struct link_params
*params
,
5555 struct link_vars
*vars
)
5557 struct bnx2x
*bp
= params
->bp
;
5559 u16 gp_status
, duplex
= DUPLEX_HALF
, link_up
= 0, speed_mask
;
5562 /* Read gp_status */
5563 CL22_RD_OVER_CL45(bp
, phy
,
5564 MDIO_REG_BANK_GP_STATUS
,
5565 MDIO_GP_STATUS_TOP_AN_STATUS1
,
5567 if (gp_status
& MDIO_GP_STATUS_TOP_AN_STATUS1_DUPLEX_STATUS
)
5568 duplex
= DUPLEX_FULL
;
5569 if (gp_status
& MDIO_GP_STATUS_TOP_AN_STATUS1_LINK_STATUS
)
5571 speed_mask
= gp_status
& GP_STATUS_SPEED_MASK
;
5572 DP(NETIF_MSG_LINK
, "gp_status 0x%x, is_link_up %d, speed_mask 0x%x\n",
5573 gp_status
, link_up
, speed_mask
);
5574 rc
= bnx2x_get_link_speed_duplex(phy
, params
, vars
, link_up
, speed_mask
,
5579 if (gp_status
& MDIO_GP_STATUS_TOP_AN_STATUS1_LINK_STATUS
) {
5580 if (SINGLE_MEDIA_DIRECT(params
)) {
5581 vars
->duplex
= duplex
;
5582 bnx2x_flow_ctrl_resolve(phy
, params
, vars
, gp_status
);
5583 if (phy
->req_line_speed
== SPEED_AUTO_NEG
)
5584 bnx2x_xgxs_an_resolve(phy
, params
, vars
,
5587 } else { /* Link_down */
5588 if ((phy
->req_line_speed
== SPEED_AUTO_NEG
) &&
5589 SINGLE_MEDIA_DIRECT(params
)) {
5590 /* Check signal is detected */
5591 bnx2x_check_fallback_to_cl37(phy
, params
);
5595 /* Read LP advertised speeds*/
5596 if (SINGLE_MEDIA_DIRECT(params
) &&
5597 (vars
->link_status
& LINK_STATUS_AUTO_NEGOTIATE_COMPLETE
)) {
5600 CL22_RD_OVER_CL45(bp
, phy
, MDIO_REG_BANK_CL73_IEEEB1
,
5601 MDIO_CL73_IEEEB1_AN_LP_ADV2
, &val
);
5603 if (val
& MDIO_CL73_IEEEB1_AN_ADV2_ADVR_1000M_KX
)
5604 vars
->link_status
|=
5605 LINK_STATUS_LINK_PARTNER_1000TFD_CAPABLE
;
5606 if (val
& (MDIO_CL73_IEEEB1_AN_ADV2_ADVR_10G_KX4
|
5607 MDIO_CL73_IEEEB1_AN_ADV2_ADVR_10G_KR
))
5608 vars
->link_status
|=
5609 LINK_STATUS_LINK_PARTNER_10GXFD_CAPABLE
;
5611 CL22_RD_OVER_CL45(bp
, phy
, MDIO_REG_BANK_OVER_1G
,
5612 MDIO_OVER_1G_LP_UP1
, &val
);
5614 if (val
& MDIO_OVER_1G_UP1_2_5G
)
5615 vars
->link_status
|=
5616 LINK_STATUS_LINK_PARTNER_2500XFD_CAPABLE
;
5617 if (val
& (MDIO_OVER_1G_UP1_10G
| MDIO_OVER_1G_UP1_10GH
))
5618 vars
->link_status
|=
5619 LINK_STATUS_LINK_PARTNER_10GXFD_CAPABLE
;
5622 DP(NETIF_MSG_LINK
, "duplex %x flow_ctrl 0x%x link_status 0x%x\n",
5623 vars
->duplex
, vars
->flow_ctrl
, vars
->link_status
);
5627 static int bnx2x_warpcore_read_status(struct bnx2x_phy
*phy
,
5628 struct link_params
*params
,
5629 struct link_vars
*vars
)
5631 struct bnx2x
*bp
= params
->bp
;
5633 u16 gp_status1
, gp_speed
, link_up
, duplex
= DUPLEX_FULL
;
5635 lane
= bnx2x_get_warpcore_lane(phy
, params
);
5636 /* Read gp_status */
5637 if ((params
->loopback_mode
) &&
5638 (phy
->flags
& FLAGS_WC_DUAL_MODE
)) {
5639 bnx2x_cl45_read(bp
, phy
, MDIO_WC_DEVAD
,
5640 MDIO_WC_REG_DIGITAL5_LINK_STATUS
, &link_up
);
5641 bnx2x_cl45_read(bp
, phy
, MDIO_WC_DEVAD
,
5642 MDIO_WC_REG_DIGITAL5_LINK_STATUS
, &link_up
);
5644 } else if ((phy
->req_line_speed
> SPEED_10000
) &&
5645 (phy
->supported
& SUPPORTED_20000baseMLD2_Full
)) {
5647 bnx2x_cl45_read(bp
, phy
, MDIO_WC_DEVAD
,
5649 bnx2x_cl45_read(bp
, phy
, MDIO_WC_DEVAD
,
5651 DP(NETIF_MSG_LINK
, "PCS RX link status = 0x%x-->0x%x\n",
5652 temp_link_up
, link_up
);
5655 bnx2x_ext_phy_resolve_fc(phy
, params
, vars
);
5657 bnx2x_cl45_read(bp
, phy
, MDIO_WC_DEVAD
,
5658 MDIO_WC_REG_GP2_STATUS_GP_2_1
,
5660 DP(NETIF_MSG_LINK
, "0x81d1 = 0x%x\n", gp_status1
);
5661 /* Check for either KR, 1G, or AN up. */
5662 link_up
= ((gp_status1
>> 8) |
5663 (gp_status1
>> 12) |
5666 if (phy
->supported
& SUPPORTED_20000baseKR2_Full
) {
5668 bnx2x_cl45_read(bp
, phy
, MDIO_AN_DEVAD
,
5669 MDIO_AN_REG_STATUS
, &an_link
);
5670 bnx2x_cl45_read(bp
, phy
, MDIO_AN_DEVAD
,
5671 MDIO_AN_REG_STATUS
, &an_link
);
5672 link_up
|= (an_link
& (1<<2));
5674 if (link_up
&& SINGLE_MEDIA_DIRECT(params
)) {
5676 if (phy
->req_line_speed
== SPEED_AUTO_NEG
) {
5677 /* Check Autoneg complete */
5678 bnx2x_cl45_read(bp
, phy
, MDIO_WC_DEVAD
,
5679 MDIO_WC_REG_GP2_STATUS_GP_2_4
,
5681 if (gp_status4
& ((1<<12)<<lane
))
5682 vars
->link_status
|=
5683 LINK_STATUS_AUTO_NEGOTIATE_COMPLETE
;
5685 /* Check parallel detect used */
5686 bnx2x_cl45_read(bp
, phy
, MDIO_WC_DEVAD
,
5687 MDIO_WC_REG_PAR_DET_10G_STATUS
,
5690 vars
->link_status
|=
5691 LINK_STATUS_PARALLEL_DETECTION_USED
;
5693 bnx2x_ext_phy_resolve_fc(phy
, params
, vars
);
5694 vars
->duplex
= duplex
;
5698 if ((vars
->link_status
& LINK_STATUS_AUTO_NEGOTIATE_COMPLETE
) &&
5699 SINGLE_MEDIA_DIRECT(params
)) {
5702 bnx2x_cl45_read(bp
, phy
, MDIO_AN_DEVAD
,
5703 MDIO_AN_REG_LP_AUTO_NEG2
, &val
);
5705 if (val
& MDIO_CL73_IEEEB1_AN_ADV2_ADVR_1000M_KX
)
5706 vars
->link_status
|=
5707 LINK_STATUS_LINK_PARTNER_1000TFD_CAPABLE
;
5708 if (val
& (MDIO_CL73_IEEEB1_AN_ADV2_ADVR_10G_KX4
|
5709 MDIO_CL73_IEEEB1_AN_ADV2_ADVR_10G_KR
))
5710 vars
->link_status
|=
5711 LINK_STATUS_LINK_PARTNER_10GXFD_CAPABLE
;
5713 bnx2x_cl45_read(bp
, phy
, MDIO_WC_DEVAD
,
5714 MDIO_WC_REG_DIGITAL3_LP_UP1
, &val
);
5716 if (val
& MDIO_OVER_1G_UP1_2_5G
)
5717 vars
->link_status
|=
5718 LINK_STATUS_LINK_PARTNER_2500XFD_CAPABLE
;
5719 if (val
& (MDIO_OVER_1G_UP1_10G
| MDIO_OVER_1G_UP1_10GH
))
5720 vars
->link_status
|=
5721 LINK_STATUS_LINK_PARTNER_10GXFD_CAPABLE
;
5727 bnx2x_cl45_read(bp
, phy
, MDIO_WC_DEVAD
,
5728 MDIO_WC_REG_GP2_STATUS_GP_2_2
, &gp_speed
);
5730 bnx2x_cl45_read(bp
, phy
, MDIO_WC_DEVAD
,
5731 MDIO_WC_REG_GP2_STATUS_GP_2_3
, &gp_speed
);
5733 DP(NETIF_MSG_LINK
, "lane %d gp_speed 0x%x\n", lane
, gp_speed
);
5735 if ((lane
& 1) == 0)
5738 link_up
= !!link_up
;
5740 rc
= bnx2x_get_link_speed_duplex(phy
, params
, vars
, link_up
, gp_speed
,
5743 DP(NETIF_MSG_LINK
, "duplex %x flow_ctrl 0x%x link_status 0x%x\n",
5744 vars
->duplex
, vars
->flow_ctrl
, vars
->link_status
);
5747 static void bnx2x_set_gmii_tx_driver(struct link_params
*params
)
5749 struct bnx2x
*bp
= params
->bp
;
5750 struct bnx2x_phy
*phy
= ¶ms
->phy
[INT_PHY
];
5756 CL22_RD_OVER_CL45(bp
, phy
,
5757 MDIO_REG_BANK_OVER_1G
,
5758 MDIO_OVER_1G_LP_UP2
, &lp_up2
);
5760 /* Bits [10:7] at lp_up2, positioned at [15:12] */
5761 lp_up2
= (((lp_up2
& MDIO_OVER_1G_LP_UP2_PREEMPHASIS_MASK
) >>
5762 MDIO_OVER_1G_LP_UP2_PREEMPHASIS_SHIFT
) <<
5763 MDIO_TX0_TX_DRIVER_PREEMPHASIS_SHIFT
);
5768 for (bank
= MDIO_REG_BANK_TX0
; bank
<= MDIO_REG_BANK_TX3
;
5769 bank
+= (MDIO_REG_BANK_TX1
- MDIO_REG_BANK_TX0
)) {
5770 CL22_RD_OVER_CL45(bp
, phy
,
5772 MDIO_TX0_TX_DRIVER
, &tx_driver
);
5774 /* Replace tx_driver bits [15:12] */
5776 (tx_driver
& MDIO_TX0_TX_DRIVER_PREEMPHASIS_MASK
)) {
5777 tx_driver
&= ~MDIO_TX0_TX_DRIVER_PREEMPHASIS_MASK
;
5778 tx_driver
|= lp_up2
;
5779 CL22_WR_OVER_CL45(bp
, phy
,
5781 MDIO_TX0_TX_DRIVER
, tx_driver
);
5786 static int bnx2x_emac_program(struct link_params
*params
,
5787 struct link_vars
*vars
)
5789 struct bnx2x
*bp
= params
->bp
;
5790 u8 port
= params
->port
;
5793 DP(NETIF_MSG_LINK
, "setting link speed & duplex\n");
5794 bnx2x_bits_dis(bp
, GRCBASE_EMAC0
+ port
*0x400 +
5796 (EMAC_MODE_25G_MODE
|
5797 EMAC_MODE_PORT_MII_10M
|
5798 EMAC_MODE_HALF_DUPLEX
));
5799 switch (vars
->line_speed
) {
5801 mode
|= EMAC_MODE_PORT_MII_10M
;
5805 mode
|= EMAC_MODE_PORT_MII
;
5809 mode
|= EMAC_MODE_PORT_GMII
;
5813 mode
|= (EMAC_MODE_25G_MODE
| EMAC_MODE_PORT_GMII
);
5817 /* 10G not valid for EMAC */
5818 DP(NETIF_MSG_LINK
, "Invalid line_speed 0x%x\n",
5823 if (vars
->duplex
== DUPLEX_HALF
)
5824 mode
|= EMAC_MODE_HALF_DUPLEX
;
5826 GRCBASE_EMAC0
+ port
*0x400 + EMAC_REG_EMAC_MODE
,
5829 bnx2x_set_led(params
, vars
, LED_MODE_OPER
, vars
->line_speed
);
5833 static void bnx2x_set_preemphasis(struct bnx2x_phy
*phy
,
5834 struct link_params
*params
)
5838 struct bnx2x
*bp
= params
->bp
;
5840 for (bank
= MDIO_REG_BANK_RX0
, i
= 0; bank
<= MDIO_REG_BANK_RX3
;
5841 bank
+= (MDIO_REG_BANK_RX1
-MDIO_REG_BANK_RX0
), i
++) {
5842 CL22_WR_OVER_CL45(bp
, phy
,
5844 MDIO_RX0_RX_EQ_BOOST
,
5845 phy
->rx_preemphasis
[i
]);
5848 for (bank
= MDIO_REG_BANK_TX0
, i
= 0; bank
<= MDIO_REG_BANK_TX3
;
5849 bank
+= (MDIO_REG_BANK_TX1
- MDIO_REG_BANK_TX0
), i
++) {
5850 CL22_WR_OVER_CL45(bp
, phy
,
5853 phy
->tx_preemphasis
[i
]);
5857 static void bnx2x_xgxs_config_init(struct bnx2x_phy
*phy
,
5858 struct link_params
*params
,
5859 struct link_vars
*vars
)
5861 struct bnx2x
*bp
= params
->bp
;
5862 u8 enable_cl73
= (SINGLE_MEDIA_DIRECT(params
) ||
5863 (params
->loopback_mode
== LOOPBACK_XGXS
));
5864 if (!(vars
->phy_flags
& PHY_SGMII_FLAG
)) {
5865 if (SINGLE_MEDIA_DIRECT(params
) &&
5866 (params
->feature_config_flags
&
5867 FEATURE_CONFIG_OVERRIDE_PREEMPHASIS_ENABLED
))
5868 bnx2x_set_preemphasis(phy
, params
);
5870 /* Forced speed requested? */
5871 if (vars
->line_speed
!= SPEED_AUTO_NEG
||
5872 (SINGLE_MEDIA_DIRECT(params
) &&
5873 params
->loopback_mode
== LOOPBACK_EXT
)) {
5874 DP(NETIF_MSG_LINK
, "not SGMII, no AN\n");
5876 /* Disable autoneg */
5877 bnx2x_set_autoneg(phy
, params
, vars
, 0);
5879 /* Program speed and duplex */
5880 bnx2x_program_serdes(phy
, params
, vars
);
5882 } else { /* AN_mode */
5883 DP(NETIF_MSG_LINK
, "not SGMII, AN\n");
5886 bnx2x_set_brcm_cl37_advertisement(phy
, params
);
5888 /* Program duplex & pause advertisement (for aneg) */
5889 bnx2x_set_ieee_aneg_advertisement(phy
, params
,
5892 /* Enable autoneg */
5893 bnx2x_set_autoneg(phy
, params
, vars
, enable_cl73
);
5895 /* Enable and restart AN */
5896 bnx2x_restart_autoneg(phy
, params
, enable_cl73
);
5899 } else { /* SGMII mode */
5900 DP(NETIF_MSG_LINK
, "SGMII\n");
5902 bnx2x_initialize_sgmii_process(phy
, params
, vars
);
5906 static int bnx2x_prepare_xgxs(struct bnx2x_phy
*phy
,
5907 struct link_params
*params
,
5908 struct link_vars
*vars
)
5911 vars
->phy_flags
|= PHY_XGXS_FLAG
;
5912 if ((phy
->req_line_speed
&&
5913 ((phy
->req_line_speed
== SPEED_100
) ||
5914 (phy
->req_line_speed
== SPEED_10
))) ||
5915 (!phy
->req_line_speed
&&
5916 (phy
->speed_cap_mask
>=
5917 PORT_HW_CFG_SPEED_CAPABILITY_D0_10M_FULL
) &&
5918 (phy
->speed_cap_mask
<
5919 PORT_HW_CFG_SPEED_CAPABILITY_D0_1G
)) ||
5920 (phy
->type
== PORT_HW_CFG_SERDES_EXT_PHY_TYPE_DIRECT_SD
))
5921 vars
->phy_flags
|= PHY_SGMII_FLAG
;
5923 vars
->phy_flags
&= ~PHY_SGMII_FLAG
;
5925 bnx2x_calc_ieee_aneg_adv(phy
, params
, &vars
->ieee_fc
);
5926 bnx2x_set_aer_mmd(params
, phy
);
5927 if (phy
->type
== PORT_HW_CFG_XGXS_EXT_PHY_TYPE_DIRECT
)
5928 bnx2x_set_master_ln(params
, phy
);
5930 rc
= bnx2x_reset_unicore(params
, phy
, 0);
5931 /* Reset the SerDes and wait for reset bit return low */
5935 bnx2x_set_aer_mmd(params
, phy
);
5936 /* Setting the masterLn_def again after the reset */
5937 if (phy
->type
== PORT_HW_CFG_XGXS_EXT_PHY_TYPE_DIRECT
) {
5938 bnx2x_set_master_ln(params
, phy
);
5939 bnx2x_set_swap_lanes(params
, phy
);
5945 static u16
bnx2x_wait_reset_complete(struct bnx2x
*bp
,
5946 struct bnx2x_phy
*phy
,
5947 struct link_params
*params
)
5950 /* Wait for soft reset to get cleared up to 1 sec */
5951 for (cnt
= 0; cnt
< 1000; cnt
++) {
5952 if (phy
->type
== PORT_HW_CFG_XGXS_EXT_PHY_TYPE_BCM54618SE
)
5953 bnx2x_cl22_read(bp
, phy
,
5954 MDIO_PMA_REG_CTRL
, &ctrl
);
5956 bnx2x_cl45_read(bp
, phy
,
5958 MDIO_PMA_REG_CTRL
, &ctrl
);
5959 if (!(ctrl
& (1<<15)))
5961 usleep_range(1000, 2000);
5965 netdev_err(bp
->dev
, "Warning: PHY was not initialized,"
5968 DP(NETIF_MSG_LINK
, "control reg 0x%x (after %d ms)\n", ctrl
, cnt
);
5972 static void bnx2x_link_int_enable(struct link_params
*params
)
5974 u8 port
= params
->port
;
5976 struct bnx2x
*bp
= params
->bp
;
5978 /* Setting the status to report on link up for either XGXS or SerDes */
5979 if (CHIP_IS_E3(bp
)) {
5980 mask
= NIG_MASK_XGXS0_LINK_STATUS
;
5981 if (!(SINGLE_MEDIA_DIRECT(params
)))
5982 mask
|= NIG_MASK_MI_INT
;
5983 } else if (params
->switch_cfg
== SWITCH_CFG_10G
) {
5984 mask
= (NIG_MASK_XGXS0_LINK10G
|
5985 NIG_MASK_XGXS0_LINK_STATUS
);
5986 DP(NETIF_MSG_LINK
, "enabled XGXS interrupt\n");
5987 if (!(SINGLE_MEDIA_DIRECT(params
)) &&
5988 params
->phy
[INT_PHY
].type
!=
5989 PORT_HW_CFG_XGXS_EXT_PHY_TYPE_FAILURE
) {
5990 mask
|= NIG_MASK_MI_INT
;
5991 DP(NETIF_MSG_LINK
, "enabled external phy int\n");
5994 } else { /* SerDes */
5995 mask
= NIG_MASK_SERDES0_LINK_STATUS
;
5996 DP(NETIF_MSG_LINK
, "enabled SerDes interrupt\n");
5997 if (!(SINGLE_MEDIA_DIRECT(params
)) &&
5998 params
->phy
[INT_PHY
].type
!=
5999 PORT_HW_CFG_SERDES_EXT_PHY_TYPE_NOT_CONN
) {
6000 mask
|= NIG_MASK_MI_INT
;
6001 DP(NETIF_MSG_LINK
, "enabled external phy int\n");
6005 NIG_REG_MASK_INTERRUPT_PORT0
+ port
*4,
6008 DP(NETIF_MSG_LINK
, "port %x, is_xgxs %x, int_status 0x%x\n", port
,
6009 (params
->switch_cfg
== SWITCH_CFG_10G
),
6010 REG_RD(bp
, NIG_REG_STATUS_INTERRUPT_PORT0
+ port
*4));
6011 DP(NETIF_MSG_LINK
, " int_mask 0x%x, MI_INT %x, SERDES_LINK %x\n",
6012 REG_RD(bp
, NIG_REG_MASK_INTERRUPT_PORT0
+ port
*4),
6013 REG_RD(bp
, NIG_REG_EMAC0_STATUS_MISC_MI_INT
+ port
*0x18),
6014 REG_RD(bp
, NIG_REG_SERDES0_STATUS_LINK_STATUS
+port
*0x3c));
6015 DP(NETIF_MSG_LINK
, " 10G %x, XGXS_LINK %x\n",
6016 REG_RD(bp
, NIG_REG_XGXS0_STATUS_LINK10G
+ port
*0x68),
6017 REG_RD(bp
, NIG_REG_XGXS0_STATUS_LINK_STATUS
+ port
*0x68));
6020 static void bnx2x_rearm_latch_signal(struct bnx2x
*bp
, u8 port
,
6023 u32 latch_status
= 0;
6025 /* Disable the MI INT ( external phy int ) by writing 1 to the
6026 * status register. Link down indication is high-active-signal,
6027 * so in this case we need to write the status to clear the XOR
6029 /* Read Latched signals */
6030 latch_status
= REG_RD(bp
,
6031 NIG_REG_LATCH_STATUS_0
+ port
*8);
6032 DP(NETIF_MSG_LINK
, "latch_status = 0x%x\n", latch_status
);
6033 /* Handle only those with latched-signal=up.*/
6036 NIG_REG_STATUS_INTERRUPT_PORT0
6038 NIG_STATUS_EMAC0_MI_INT
);
6041 NIG_REG_STATUS_INTERRUPT_PORT0
6043 NIG_STATUS_EMAC0_MI_INT
);
6045 if (latch_status
& 1) {
6047 /* For all latched-signal=up : Re-Arm Latch signals */
6048 REG_WR(bp
, NIG_REG_LATCH_STATUS_0
+ port
*8,
6049 (latch_status
& 0xfffe) | (latch_status
& 1));
6051 /* For all latched-signal=up,Write original_signal to status */
6054 static void bnx2x_link_int_ack(struct link_params
*params
,
6055 struct link_vars
*vars
, u8 is_10g_plus
)
6057 struct bnx2x
*bp
= params
->bp
;
6058 u8 port
= params
->port
;
6060 /* First reset all status we assume only one line will be
6063 bnx2x_bits_dis(bp
, NIG_REG_STATUS_INTERRUPT_PORT0
+ port
*4,
6064 (NIG_STATUS_XGXS0_LINK10G
|
6065 NIG_STATUS_XGXS0_LINK_STATUS
|
6066 NIG_STATUS_SERDES0_LINK_STATUS
));
6067 if (vars
->phy_link_up
) {
6068 if (USES_WARPCORE(bp
))
6069 mask
= NIG_STATUS_XGXS0_LINK_STATUS
;
6072 mask
= NIG_STATUS_XGXS0_LINK10G
;
6073 else if (params
->switch_cfg
== SWITCH_CFG_10G
) {
6074 /* Disable the link interrupt by writing 1 to
6075 * the relevant lane in the status register
6078 ((params
->lane_config
&
6079 PORT_HW_CFG_LANE_SWAP_CFG_MASTER_MASK
) >>
6080 PORT_HW_CFG_LANE_SWAP_CFG_MASTER_SHIFT
);
6081 mask
= ((1 << ser_lane
) <<
6082 NIG_STATUS_XGXS0_LINK_STATUS_SIZE
);
6084 mask
= NIG_STATUS_SERDES0_LINK_STATUS
;
6086 DP(NETIF_MSG_LINK
, "Ack link up interrupt with mask 0x%x\n",
6089 NIG_REG_STATUS_INTERRUPT_PORT0
+ port
*4,
6094 static int bnx2x_format_ver(u32 num
, u8
*str
, u16
*len
)
6097 u32 mask
= 0xf0000000;
6100 u8 remove_leading_zeros
= 1;
6102 /* Need more than 10chars for this format */
6110 digit
= ((num
& mask
) >> shift
);
6111 if (digit
== 0 && remove_leading_zeros
) {
6114 } else if (digit
< 0xa)
6115 *str_ptr
= digit
+ '0';
6117 *str_ptr
= digit
- 0xa + 'a';
6118 remove_leading_zeros
= 0;
6126 remove_leading_zeros
= 1;
6133 static int bnx2x_null_format_ver(u32 spirom_ver
, u8
*str
, u16
*len
)
6140 int bnx2x_get_ext_phy_fw_version(struct link_params
*params
, u8
*version
,
6146 u8
*ver_p
= version
;
6147 u16 remain_len
= len
;
6148 if (version
== NULL
|| params
== NULL
)
6152 /* Extract first external phy*/
6154 spirom_ver
= REG_RD(bp
, params
->phy
[EXT_PHY1
].ver_addr
);
6156 if (params
->phy
[EXT_PHY1
].format_fw_ver
) {
6157 status
|= params
->phy
[EXT_PHY1
].format_fw_ver(spirom_ver
,
6160 ver_p
+= (len
- remain_len
);
6162 if ((params
->num_phys
== MAX_PHYS
) &&
6163 (params
->phy
[EXT_PHY2
].ver_addr
!= 0)) {
6164 spirom_ver
= REG_RD(bp
, params
->phy
[EXT_PHY2
].ver_addr
);
6165 if (params
->phy
[EXT_PHY2
].format_fw_ver
) {
6169 status
|= params
->phy
[EXT_PHY2
].format_fw_ver(
6173 ver_p
= version
+ (len
- remain_len
);
6180 static void bnx2x_set_xgxs_loopback(struct bnx2x_phy
*phy
,
6181 struct link_params
*params
)
6183 u8 port
= params
->port
;
6184 struct bnx2x
*bp
= params
->bp
;
6186 if (phy
->req_line_speed
!= SPEED_1000
) {
6189 DP(NETIF_MSG_LINK
, "XGXS 10G loopback enable\n");
6191 if (!CHIP_IS_E3(bp
)) {
6192 /* Change the uni_phy_addr in the nig */
6193 md_devad
= REG_RD(bp
, (NIG_REG_XGXS0_CTRL_MD_DEVAD
+
6196 REG_WR(bp
, NIG_REG_XGXS0_CTRL_MD_DEVAD
+ port
*0x18,
6200 bnx2x_cl45_write(bp
, phy
,
6202 (MDIO_REG_BANK_AER_BLOCK
+
6203 (MDIO_AER_BLOCK_AER_REG
& 0xf)),
6206 bnx2x_cl45_write(bp
, phy
,
6208 (MDIO_REG_BANK_CL73_IEEEB0
+
6209 (MDIO_CL73_IEEEB0_CL73_AN_CONTROL
& 0xf)),
6212 /* Set aer mmd back */
6213 bnx2x_set_aer_mmd(params
, phy
);
6215 if (!CHIP_IS_E3(bp
)) {
6217 REG_WR(bp
, NIG_REG_XGXS0_CTRL_MD_DEVAD
+ port
*0x18,
6222 DP(NETIF_MSG_LINK
, "XGXS 1G loopback enable\n");
6223 bnx2x_cl45_read(bp
, phy
, 5,
6224 (MDIO_REG_BANK_COMBO_IEEE0
+
6225 (MDIO_COMBO_IEEE0_MII_CONTROL
& 0xf)),
6227 bnx2x_cl45_write(bp
, phy
, 5,
6228 (MDIO_REG_BANK_COMBO_IEEE0
+
6229 (MDIO_COMBO_IEEE0_MII_CONTROL
& 0xf)),
6231 MDIO_COMBO_IEEO_MII_CONTROL_LOOPBACK
);
6235 int bnx2x_set_led(struct link_params
*params
,
6236 struct link_vars
*vars
, u8 mode
, u32 speed
)
6238 u8 port
= params
->port
;
6239 u16 hw_led_mode
= params
->hw_led_mode
;
6243 u32 emac_base
= port
? GRCBASE_EMAC1
: GRCBASE_EMAC0
;
6244 struct bnx2x
*bp
= params
->bp
;
6245 DP(NETIF_MSG_LINK
, "bnx2x_set_led: port %x, mode %d\n", port
, mode
);
6246 DP(NETIF_MSG_LINK
, "speed 0x%x, hw_led_mode 0x%x\n",
6247 speed
, hw_led_mode
);
6249 for (phy_idx
= EXT_PHY1
; phy_idx
< MAX_PHYS
; phy_idx
++) {
6250 if (params
->phy
[phy_idx
].set_link_led
) {
6251 params
->phy
[phy_idx
].set_link_led(
6252 ¶ms
->phy
[phy_idx
], params
, mode
);
6257 case LED_MODE_FRONT_PANEL_OFF
:
6259 REG_WR(bp
, NIG_REG_LED_10G_P0
+ port
*4, 0);
6260 REG_WR(bp
, NIG_REG_LED_MODE_P0
+ port
*4,
6261 SHARED_HW_CFG_LED_MAC1
);
6263 tmp
= EMAC_RD(bp
, EMAC_REG_EMAC_LED
);
6264 if (params
->phy
[EXT_PHY1
].type
==
6265 PORT_HW_CFG_XGXS_EXT_PHY_TYPE_BCM54618SE
)
6266 tmp
&= ~(EMAC_LED_1000MB_OVERRIDE
|
6267 EMAC_LED_100MB_OVERRIDE
|
6268 EMAC_LED_10MB_OVERRIDE
);
6270 tmp
|= EMAC_LED_OVERRIDE
;
6272 EMAC_WR(bp
, EMAC_REG_EMAC_LED
, tmp
);
6276 /* For all other phys, OPER mode is same as ON, so in case
6277 * link is down, do nothing
6282 if (((params
->phy
[EXT_PHY1
].type
==
6283 PORT_HW_CFG_XGXS_EXT_PHY_TYPE_BCM8727
) ||
6284 (params
->phy
[EXT_PHY1
].type
==
6285 PORT_HW_CFG_XGXS_EXT_PHY_TYPE_BCM8722
)) &&
6286 CHIP_IS_E2(bp
) && params
->num_phys
== 2) {
6287 /* This is a work-around for E2+8727 Configurations */
6288 if (mode
== LED_MODE_ON
||
6289 speed
== SPEED_10000
){
6290 REG_WR(bp
, NIG_REG_LED_MODE_P0
+ port
*4, 0);
6291 REG_WR(bp
, NIG_REG_LED_10G_P0
+ port
*4, 1);
6293 tmp
= EMAC_RD(bp
, EMAC_REG_EMAC_LED
);
6294 EMAC_WR(bp
, EMAC_REG_EMAC_LED
,
6295 (tmp
| EMAC_LED_OVERRIDE
));
6296 /* Return here without enabling traffic
6297 * LED blink and setting rate in ON mode.
6298 * In oper mode, enabling LED blink
6299 * and setting rate is needed.
6301 if (mode
== LED_MODE_ON
)
6304 } else if (SINGLE_MEDIA_DIRECT(params
)) {
6305 /* This is a work-around for HW issue found when link
6308 if ((!CHIP_IS_E3(bp
)) ||
6310 mode
== LED_MODE_ON
))
6311 REG_WR(bp
, NIG_REG_LED_10G_P0
+ port
*4, 1);
6313 if (CHIP_IS_E1x(bp
) ||
6315 (mode
== LED_MODE_ON
))
6316 REG_WR(bp
, NIG_REG_LED_MODE_P0
+ port
*4, 0);
6318 REG_WR(bp
, NIG_REG_LED_MODE_P0
+ port
*4,
6320 } else if ((params
->phy
[EXT_PHY1
].type
==
6321 PORT_HW_CFG_XGXS_EXT_PHY_TYPE_BCM54618SE
) &&
6322 (mode
== LED_MODE_ON
)) {
6323 REG_WR(bp
, NIG_REG_LED_MODE_P0
+ port
*4, 0);
6324 tmp
= EMAC_RD(bp
, EMAC_REG_EMAC_LED
);
6325 EMAC_WR(bp
, EMAC_REG_EMAC_LED
, tmp
|
6326 EMAC_LED_OVERRIDE
| EMAC_LED_1000MB_OVERRIDE
);
6327 /* Break here; otherwise, it'll disable the
6328 * intended override.
6332 REG_WR(bp
, NIG_REG_LED_MODE_P0
+ port
*4,
6335 REG_WR(bp
, NIG_REG_LED_CONTROL_OVERRIDE_TRAFFIC_P0
+ port
*4, 0);
6336 /* Set blinking rate to ~15.9Hz */
6338 REG_WR(bp
, NIG_REG_LED_CONTROL_BLINK_RATE_P0
+ port
*4,
6339 LED_BLINK_RATE_VAL_E3
);
6341 REG_WR(bp
, NIG_REG_LED_CONTROL_BLINK_RATE_P0
+ port
*4,
6342 LED_BLINK_RATE_VAL_E1X_E2
);
6343 REG_WR(bp
, NIG_REG_LED_CONTROL_BLINK_RATE_ENA_P0
+
6345 tmp
= EMAC_RD(bp
, EMAC_REG_EMAC_LED
);
6346 EMAC_WR(bp
, EMAC_REG_EMAC_LED
,
6347 (tmp
& (~EMAC_LED_OVERRIDE
)));
6349 if (CHIP_IS_E1(bp
) &&
6350 ((speed
== SPEED_2500
) ||
6351 (speed
== SPEED_1000
) ||
6352 (speed
== SPEED_100
) ||
6353 (speed
== SPEED_10
))) {
6354 /* For speeds less than 10G LED scheme is different */
6355 REG_WR(bp
, NIG_REG_LED_CONTROL_OVERRIDE_TRAFFIC_P0
6357 REG_WR(bp
, NIG_REG_LED_CONTROL_TRAFFIC_P0
+
6359 REG_WR(bp
, NIG_REG_LED_CONTROL_BLINK_TRAFFIC_P0
+
6366 DP(NETIF_MSG_LINK
, "bnx2x_set_led: Invalid led mode %d\n",
6374 /* This function comes to reflect the actual link state read DIRECTLY from the
6377 int bnx2x_test_link(struct link_params
*params
, struct link_vars
*vars
,
6380 struct bnx2x
*bp
= params
->bp
;
6381 u16 gp_status
= 0, phy_index
= 0;
6382 u8 ext_phy_link_up
= 0, serdes_phy_type
;
6383 struct link_vars temp_vars
;
6384 struct bnx2x_phy
*int_phy
= ¶ms
->phy
[INT_PHY
];
6386 if (CHIP_IS_E3(bp
)) {
6388 if (params
->req_line_speed
[LINK_CONFIG_IDX(INT_PHY
)]
6390 /* Check 20G link */
6391 bnx2x_cl45_read(bp
, int_phy
, MDIO_WC_DEVAD
,
6393 bnx2x_cl45_read(bp
, int_phy
, MDIO_WC_DEVAD
,
6397 /* Check 10G link and below*/
6398 u8 lane
= bnx2x_get_warpcore_lane(int_phy
, params
);
6399 bnx2x_cl45_read(bp
, int_phy
, MDIO_WC_DEVAD
,
6400 MDIO_WC_REG_GP2_STATUS_GP_2_1
,
6402 gp_status
= ((gp_status
>> 8) & 0xf) |
6403 ((gp_status
>> 12) & 0xf);
6404 link_up
= gp_status
& (1 << lane
);
6409 CL22_RD_OVER_CL45(bp
, int_phy
,
6410 MDIO_REG_BANK_GP_STATUS
,
6411 MDIO_GP_STATUS_TOP_AN_STATUS1
,
6413 /* Link is up only if both local phy and external phy are up */
6414 if (!(gp_status
& MDIO_GP_STATUS_TOP_AN_STATUS1_LINK_STATUS
))
6417 /* In XGXS loopback mode, do not check external PHY */
6418 if (params
->loopback_mode
== LOOPBACK_XGXS
)
6421 switch (params
->num_phys
) {
6423 /* No external PHY */
6426 ext_phy_link_up
= params
->phy
[EXT_PHY1
].read_status(
6427 ¶ms
->phy
[EXT_PHY1
],
6428 params
, &temp_vars
);
6430 case 3: /* Dual Media */
6431 for (phy_index
= EXT_PHY1
; phy_index
< params
->num_phys
;
6433 serdes_phy_type
= ((params
->phy
[phy_index
].media_type
==
6434 ETH_PHY_SFPP_10G_FIBER
) ||
6435 (params
->phy
[phy_index
].media_type
==
6436 ETH_PHY_SFP_1G_FIBER
) ||
6437 (params
->phy
[phy_index
].media_type
==
6438 ETH_PHY_XFP_FIBER
) ||
6439 (params
->phy
[phy_index
].media_type
==
6440 ETH_PHY_DA_TWINAX
));
6442 if (is_serdes
!= serdes_phy_type
)
6444 if (params
->phy
[phy_index
].read_status
) {
6446 params
->phy
[phy_index
].read_status(
6447 ¶ms
->phy
[phy_index
],
6448 params
, &temp_vars
);
6453 if (ext_phy_link_up
)
6458 static int bnx2x_link_initialize(struct link_params
*params
,
6459 struct link_vars
*vars
)
6462 u8 phy_index
, non_ext_phy
;
6463 struct bnx2x
*bp
= params
->bp
;
6464 /* In case of external phy existence, the line speed would be the
6465 * line speed linked up by the external phy. In case it is direct
6466 * only, then the line_speed during initialization will be
6467 * equal to the req_line_speed
6469 vars
->line_speed
= params
->phy
[INT_PHY
].req_line_speed
;
6471 /* Initialize the internal phy in case this is a direct board
6472 * (no external phys), or this board has external phy which requires
6475 if (!USES_WARPCORE(bp
))
6476 bnx2x_prepare_xgxs(¶ms
->phy
[INT_PHY
], params
, vars
);
6477 /* init ext phy and enable link state int */
6478 non_ext_phy
= (SINGLE_MEDIA_DIRECT(params
) ||
6479 (params
->loopback_mode
== LOOPBACK_XGXS
));
6482 (params
->phy
[EXT_PHY1
].flags
& FLAGS_INIT_XGXS_FIRST
) ||
6483 (params
->loopback_mode
== LOOPBACK_EXT_PHY
)) {
6484 struct bnx2x_phy
*phy
= ¶ms
->phy
[INT_PHY
];
6485 if (vars
->line_speed
== SPEED_AUTO_NEG
&&
6488 bnx2x_set_parallel_detection(phy
, params
);
6489 if (params
->phy
[INT_PHY
].config_init
)
6490 params
->phy
[INT_PHY
].config_init(phy
,
6495 /* Init external phy*/
6497 if (params
->phy
[INT_PHY
].supported
&
6499 vars
->link_status
|= LINK_STATUS_SERDES_LINK
;
6501 for (phy_index
= EXT_PHY1
; phy_index
< params
->num_phys
;
6503 /* No need to initialize second phy in case of first
6504 * phy only selection. In case of second phy, we do
6505 * need to initialize the first phy, since they are
6508 if (params
->phy
[phy_index
].supported
&
6510 vars
->link_status
|= LINK_STATUS_SERDES_LINK
;
6512 if (phy_index
== EXT_PHY2
&&
6513 (bnx2x_phy_selection(params
) ==
6514 PORT_HW_CFG_PHY_SELECTION_FIRST_PHY
)) {
6516 "Not initializing second phy\n");
6519 params
->phy
[phy_index
].config_init(
6520 ¶ms
->phy
[phy_index
],
6524 /* Reset the interrupt indication after phy was initialized */
6525 bnx2x_bits_dis(bp
, NIG_REG_STATUS_INTERRUPT_PORT0
+
6527 (NIG_STATUS_XGXS0_LINK10G
|
6528 NIG_STATUS_XGXS0_LINK_STATUS
|
6529 NIG_STATUS_SERDES0_LINK_STATUS
|
6534 static void bnx2x_int_link_reset(struct bnx2x_phy
*phy
,
6535 struct link_params
*params
)
6537 /* Reset the SerDes/XGXS */
6538 REG_WR(params
->bp
, GRCBASE_MISC
+ MISC_REGISTERS_RESET_REG_3_CLEAR
,
6539 (0x1ff << (params
->port
*16)));
6542 static void bnx2x_common_ext_link_reset(struct bnx2x_phy
*phy
,
6543 struct link_params
*params
)
6545 struct bnx2x
*bp
= params
->bp
;
6549 gpio_port
= BP_PATH(bp
);
6551 gpio_port
= params
->port
;
6552 bnx2x_set_gpio(bp
, MISC_REGISTERS_GPIO_1
,
6553 MISC_REGISTERS_GPIO_OUTPUT_LOW
,
6555 bnx2x_set_gpio(bp
, MISC_REGISTERS_GPIO_2
,
6556 MISC_REGISTERS_GPIO_OUTPUT_LOW
,
6558 DP(NETIF_MSG_LINK
, "reset external PHY\n");
6561 static int bnx2x_update_link_down(struct link_params
*params
,
6562 struct link_vars
*vars
)
6564 struct bnx2x
*bp
= params
->bp
;
6565 u8 port
= params
->port
;
6567 DP(NETIF_MSG_LINK
, "Port %x: Link is down\n", port
);
6568 bnx2x_set_led(params
, vars
, LED_MODE_OFF
, 0);
6569 vars
->phy_flags
&= ~PHY_PHYSICAL_LINK_FLAG
;
6570 /* Indicate no mac active */
6571 vars
->mac_type
= MAC_TYPE_NONE
;
6573 /* Update shared memory */
6574 vars
->link_status
&= ~LINK_UPDATE_MASK
;
6575 vars
->line_speed
= 0;
6576 bnx2x_update_mng(params
, vars
->link_status
);
6578 /* Activate nig drain */
6579 REG_WR(bp
, NIG_REG_EGRESS_DRAIN0_MODE
+ port
*4, 1);
6582 if (!CHIP_IS_E3(bp
))
6583 REG_WR(bp
, NIG_REG_NIG_EMAC0_EN
+ port
*4, 0);
6585 usleep_range(10000, 20000);
6586 /* Reset BigMac/Xmac */
6587 if (CHIP_IS_E1x(bp
) ||
6589 bnx2x_set_bmac_rx(bp
, params
->chip_id
, params
->port
, 0);
6591 if (CHIP_IS_E3(bp
)) {
6592 /* Prevent LPI Generation by chip */
6593 REG_WR(bp
, MISC_REG_CPMU_LP_FW_ENABLE_P0
+ (params
->port
<< 2),
6595 REG_WR(bp
, MISC_REG_CPMU_LP_MASK_ENT_P0
+ (params
->port
<< 2),
6597 vars
->eee_status
&= ~(SHMEM_EEE_LP_ADV_STATUS_MASK
|
6598 SHMEM_EEE_ACTIVE_BIT
);
6600 bnx2x_update_mng_eee(params
, vars
->eee_status
);
6601 bnx2x_set_xmac_rxtx(params
, 0);
6602 bnx2x_set_umac_rxtx(params
, 0);
6608 static int bnx2x_update_link_up(struct link_params
*params
,
6609 struct link_vars
*vars
,
6612 struct bnx2x
*bp
= params
->bp
;
6613 u8 phy_idx
, port
= params
->port
;
6616 vars
->link_status
|= (LINK_STATUS_LINK_UP
|
6617 LINK_STATUS_PHYSICAL_LINK_FLAG
);
6618 vars
->phy_flags
|= PHY_PHYSICAL_LINK_FLAG
;
6620 if (vars
->flow_ctrl
& BNX2X_FLOW_CTRL_TX
)
6621 vars
->link_status
|=
6622 LINK_STATUS_TX_FLOW_CONTROL_ENABLED
;
6624 if (vars
->flow_ctrl
& BNX2X_FLOW_CTRL_RX
)
6625 vars
->link_status
|=
6626 LINK_STATUS_RX_FLOW_CONTROL_ENABLED
;
6627 if (USES_WARPCORE(bp
)) {
6629 if (bnx2x_xmac_enable(params
, vars
, 0) ==
6631 DP(NETIF_MSG_LINK
, "Found errors on XMAC\n");
6633 vars
->phy_flags
|= PHY_HALF_OPEN_CONN_FLAG
;
6634 vars
->link_status
&= ~LINK_STATUS_LINK_UP
;
6637 bnx2x_umac_enable(params
, vars
, 0);
6638 bnx2x_set_led(params
, vars
,
6639 LED_MODE_OPER
, vars
->line_speed
);
6641 if ((vars
->eee_status
& SHMEM_EEE_ACTIVE_BIT
) &&
6642 (vars
->eee_status
& SHMEM_EEE_LPI_REQUESTED_BIT
)) {
6643 DP(NETIF_MSG_LINK
, "Enabling LPI assertion\n");
6644 REG_WR(bp
, MISC_REG_CPMU_LP_FW_ENABLE_P0
+
6645 (params
->port
<< 2), 1);
6646 REG_WR(bp
, MISC_REG_CPMU_LP_DR_ENABLE
, 1);
6647 REG_WR(bp
, MISC_REG_CPMU_LP_MASK_ENT_P0
+
6648 (params
->port
<< 2), 0xfc20);
6651 if ((CHIP_IS_E1x(bp
) ||
6654 if (bnx2x_bmac_enable(params
, vars
, 0, 1) ==
6656 DP(NETIF_MSG_LINK
, "Found errors on BMAC\n");
6658 vars
->phy_flags
|= PHY_HALF_OPEN_CONN_FLAG
;
6659 vars
->link_status
&= ~LINK_STATUS_LINK_UP
;
6662 bnx2x_set_led(params
, vars
,
6663 LED_MODE_OPER
, SPEED_10000
);
6665 rc
= bnx2x_emac_program(params
, vars
);
6666 bnx2x_emac_enable(params
, vars
, 0);
6669 if ((vars
->link_status
&
6670 LINK_STATUS_AUTO_NEGOTIATE_COMPLETE
)
6671 && (!(vars
->phy_flags
& PHY_SGMII_FLAG
)) &&
6672 SINGLE_MEDIA_DIRECT(params
))
6673 bnx2x_set_gmii_tx_driver(params
);
6678 if (CHIP_IS_E1x(bp
))
6679 rc
|= bnx2x_pbf_update(params
, vars
->flow_ctrl
,
6683 REG_WR(bp
, NIG_REG_EGRESS_DRAIN0_MODE
+ port
*4, 0);
6685 /* Update shared memory */
6686 bnx2x_update_mng(params
, vars
->link_status
);
6687 bnx2x_update_mng_eee(params
, vars
->eee_status
);
6688 /* Check remote fault */
6689 for (phy_idx
= INT_PHY
; phy_idx
< MAX_PHYS
; phy_idx
++) {
6690 if (params
->phy
[phy_idx
].flags
& FLAGS_TX_ERROR_CHECK
) {
6691 bnx2x_check_half_open_conn(params
, vars
, 0);
6698 /* The bnx2x_link_update function should be called upon link
6700 * Link is considered up as follows:
6701 * - DIRECT_SINGLE_MEDIA - Only XGXS link (internal link) needs
6703 * - SINGLE_MEDIA - The link between the 577xx and the external
6704 * phy (XGXS) need to up as well as the external link of the
6706 * - DUAL_MEDIA - The link between the 577xx and the first
6707 * external phy needs to be up, and at least one of the 2
6708 * external phy link must be up.
6710 int bnx2x_link_update(struct link_params
*params
, struct link_vars
*vars
)
6712 struct bnx2x
*bp
= params
->bp
;
6713 struct link_vars phy_vars
[MAX_PHYS
];
6714 u8 port
= params
->port
;
6715 u8 link_10g_plus
, phy_index
;
6716 u8 ext_phy_link_up
= 0, cur_link_up
;
6719 u16 ext_phy_line_speed
= 0, prev_line_speed
= vars
->line_speed
;
6720 u8 active_external_phy
= INT_PHY
;
6721 vars
->phy_flags
&= ~PHY_HALF_OPEN_CONN_FLAG
;
6722 vars
->link_status
&= ~LINK_UPDATE_MASK
;
6723 for (phy_index
= INT_PHY
; phy_index
< params
->num_phys
;
6725 phy_vars
[phy_index
].flow_ctrl
= 0;
6726 phy_vars
[phy_index
].link_status
= 0;
6727 phy_vars
[phy_index
].line_speed
= 0;
6728 phy_vars
[phy_index
].duplex
= DUPLEX_FULL
;
6729 phy_vars
[phy_index
].phy_link_up
= 0;
6730 phy_vars
[phy_index
].link_up
= 0;
6731 phy_vars
[phy_index
].fault_detected
= 0;
6732 /* different consideration, since vars holds inner state */
6733 phy_vars
[phy_index
].eee_status
= vars
->eee_status
;
6736 if (USES_WARPCORE(bp
))
6737 bnx2x_set_aer_mmd(params
, ¶ms
->phy
[INT_PHY
]);
6739 DP(NETIF_MSG_LINK
, "port %x, XGXS?%x, int_status 0x%x\n",
6740 port
, (vars
->phy_flags
& PHY_XGXS_FLAG
),
6741 REG_RD(bp
, NIG_REG_STATUS_INTERRUPT_PORT0
+ port
*4));
6743 is_mi_int
= (u8
)(REG_RD(bp
, NIG_REG_EMAC0_STATUS_MISC_MI_INT
+
6745 DP(NETIF_MSG_LINK
, "int_mask 0x%x MI_INT %x, SERDES_LINK %x\n",
6746 REG_RD(bp
, NIG_REG_MASK_INTERRUPT_PORT0
+ port
*4),
6748 REG_RD(bp
, NIG_REG_SERDES0_STATUS_LINK_STATUS
+ port
*0x3c));
6750 DP(NETIF_MSG_LINK
, " 10G %x, XGXS_LINK %x\n",
6751 REG_RD(bp
, NIG_REG_XGXS0_STATUS_LINK10G
+ port
*0x68),
6752 REG_RD(bp
, NIG_REG_XGXS0_STATUS_LINK_STATUS
+ port
*0x68));
6755 if (!CHIP_IS_E3(bp
))
6756 REG_WR(bp
, NIG_REG_NIG_EMAC0_EN
+ port
*4, 0);
6759 * Check external link change only for external phys, and apply
6760 * priority selection between them in case the link on both phys
6761 * is up. Note that instead of the common vars, a temporary
6762 * vars argument is used since each phy may have different link/
6763 * speed/duplex result
6765 for (phy_index
= EXT_PHY1
; phy_index
< params
->num_phys
;
6767 struct bnx2x_phy
*phy
= ¶ms
->phy
[phy_index
];
6768 if (!phy
->read_status
)
6770 /* Read link status and params of this ext phy */
6771 cur_link_up
= phy
->read_status(phy
, params
,
6772 &phy_vars
[phy_index
]);
6774 DP(NETIF_MSG_LINK
, "phy in index %d link is up\n",
6777 DP(NETIF_MSG_LINK
, "phy in index %d link is down\n",
6782 if (!ext_phy_link_up
) {
6783 ext_phy_link_up
= 1;
6784 active_external_phy
= phy_index
;
6786 switch (bnx2x_phy_selection(params
)) {
6787 case PORT_HW_CFG_PHY_SELECTION_HARDWARE_DEFAULT
:
6788 case PORT_HW_CFG_PHY_SELECTION_FIRST_PHY_PRIORITY
:
6789 /* In this option, the first PHY makes sure to pass the
6790 * traffic through itself only.
6791 * Its not clear how to reset the link on the second phy
6793 active_external_phy
= EXT_PHY1
;
6795 case PORT_HW_CFG_PHY_SELECTION_SECOND_PHY_PRIORITY
:
6796 /* In this option, the first PHY makes sure to pass the
6797 * traffic through the second PHY.
6799 active_external_phy
= EXT_PHY2
;
6802 /* Link indication on both PHYs with the following cases
6804 * - FIRST_PHY means that second phy wasn't initialized,
6805 * hence its link is expected to be down
6806 * - SECOND_PHY means that first phy should not be able
6807 * to link up by itself (using configuration)
6808 * - DEFAULT should be overriden during initialiazation
6810 DP(NETIF_MSG_LINK
, "Invalid link indication"
6811 "mpc=0x%x. DISABLING LINK !!!\n",
6812 params
->multi_phy_config
);
6813 ext_phy_link_up
= 0;
6818 prev_line_speed
= vars
->line_speed
;
6820 * Read the status of the internal phy. In case of
6821 * DIRECT_SINGLE_MEDIA board, this link is the external link,
6822 * otherwise this is the link between the 577xx and the first
6825 if (params
->phy
[INT_PHY
].read_status
)
6826 params
->phy
[INT_PHY
].read_status(
6827 ¶ms
->phy
[INT_PHY
],
6829 /* The INT_PHY flow control reside in the vars. This include the
6830 * case where the speed or flow control are not set to AUTO.
6831 * Otherwise, the active external phy flow control result is set
6832 * to the vars. The ext_phy_line_speed is needed to check if the
6833 * speed is different between the internal phy and external phy.
6834 * This case may be result of intermediate link speed change.
6836 if (active_external_phy
> INT_PHY
) {
6837 vars
->flow_ctrl
= phy_vars
[active_external_phy
].flow_ctrl
;
6838 /* Link speed is taken from the XGXS. AN and FC result from
6841 vars
->link_status
|= phy_vars
[active_external_phy
].link_status
;
6843 /* if active_external_phy is first PHY and link is up - disable
6844 * disable TX on second external PHY
6846 if (active_external_phy
== EXT_PHY1
) {
6847 if (params
->phy
[EXT_PHY2
].phy_specific_func
) {
6849 "Disabling TX on EXT_PHY2\n");
6850 params
->phy
[EXT_PHY2
].phy_specific_func(
6851 ¶ms
->phy
[EXT_PHY2
],
6852 params
, DISABLE_TX
);
6856 ext_phy_line_speed
= phy_vars
[active_external_phy
].line_speed
;
6857 vars
->duplex
= phy_vars
[active_external_phy
].duplex
;
6858 if (params
->phy
[active_external_phy
].supported
&
6860 vars
->link_status
|= LINK_STATUS_SERDES_LINK
;
6862 vars
->link_status
&= ~LINK_STATUS_SERDES_LINK
;
6864 vars
->eee_status
= phy_vars
[active_external_phy
].eee_status
;
6866 DP(NETIF_MSG_LINK
, "Active external phy selected: %x\n",
6867 active_external_phy
);
6870 for (phy_index
= EXT_PHY1
; phy_index
< params
->num_phys
;
6872 if (params
->phy
[phy_index
].flags
&
6873 FLAGS_REARM_LATCH_SIGNAL
) {
6874 bnx2x_rearm_latch_signal(bp
, port
,
6876 active_external_phy
);
6880 DP(NETIF_MSG_LINK
, "vars->flow_ctrl = 0x%x, vars->link_status = 0x%x,"
6881 " ext_phy_line_speed = %d\n", vars
->flow_ctrl
,
6882 vars
->link_status
, ext_phy_line_speed
);
6883 /* Upon link speed change set the NIG into drain mode. Comes to
6884 * deals with possible FIFO glitch due to clk change when speed
6885 * is decreased without link down indicator
6888 if (vars
->phy_link_up
) {
6889 if (!(SINGLE_MEDIA_DIRECT(params
)) && ext_phy_link_up
&&
6890 (ext_phy_line_speed
!= vars
->line_speed
)) {
6891 DP(NETIF_MSG_LINK
, "Internal link speed %d is"
6892 " different than the external"
6893 " link speed %d\n", vars
->line_speed
,
6894 ext_phy_line_speed
);
6895 vars
->phy_link_up
= 0;
6896 } else if (prev_line_speed
!= vars
->line_speed
) {
6897 REG_WR(bp
, NIG_REG_EGRESS_DRAIN0_MODE
+ params
->port
*4,
6899 usleep_range(1000, 2000);
6903 /* Anything 10 and over uses the bmac */
6904 link_10g_plus
= (vars
->line_speed
>= SPEED_10000
);
6906 bnx2x_link_int_ack(params
, vars
, link_10g_plus
);
6908 /* In case external phy link is up, and internal link is down
6909 * (not initialized yet probably after link initialization, it
6910 * needs to be initialized.
6911 * Note that after link down-up as result of cable plug, the xgxs
6912 * link would probably become up again without the need
6915 if (!(SINGLE_MEDIA_DIRECT(params
))) {
6916 DP(NETIF_MSG_LINK
, "ext_phy_link_up = %d, int_link_up = %d,"
6917 " init_preceding = %d\n", ext_phy_link_up
,
6919 params
->phy
[EXT_PHY1
].flags
&
6920 FLAGS_INIT_XGXS_FIRST
);
6921 if (!(params
->phy
[EXT_PHY1
].flags
&
6922 FLAGS_INIT_XGXS_FIRST
)
6923 && ext_phy_link_up
&& !vars
->phy_link_up
) {
6924 vars
->line_speed
= ext_phy_line_speed
;
6925 if (vars
->line_speed
< SPEED_1000
)
6926 vars
->phy_flags
|= PHY_SGMII_FLAG
;
6928 vars
->phy_flags
&= ~PHY_SGMII_FLAG
;
6930 if (params
->phy
[INT_PHY
].config_init
)
6931 params
->phy
[INT_PHY
].config_init(
6932 ¶ms
->phy
[INT_PHY
], params
,
6936 /* Link is up only if both local phy and external phy (in case of
6937 * non-direct board) are up and no fault detected on active PHY.
6939 vars
->link_up
= (vars
->phy_link_up
&&
6941 SINGLE_MEDIA_DIRECT(params
)) &&
6942 (phy_vars
[active_external_phy
].fault_detected
== 0));
6944 /* Update the PFC configuration in case it was changed */
6945 if (params
->feature_config_flags
& FEATURE_CONFIG_PFC_ENABLED
)
6946 vars
->link_status
|= LINK_STATUS_PFC_ENABLED
;
6948 vars
->link_status
&= ~LINK_STATUS_PFC_ENABLED
;
6951 rc
= bnx2x_update_link_up(params
, vars
, link_10g_plus
);
6953 rc
= bnx2x_update_link_down(params
, vars
);
6955 /* Update MCP link status was changed */
6956 if (params
->feature_config_flags
& FEATURE_CONFIG_BC_SUPPORTS_AFEX
)
6957 bnx2x_fw_command(bp
, DRV_MSG_CODE_LINK_STATUS_CHANGED
, 0);
6962 /*****************************************************************************/
6963 /* External Phy section */
6964 /*****************************************************************************/
6965 void bnx2x_ext_phy_hw_reset(struct bnx2x
*bp
, u8 port
)
6967 bnx2x_set_gpio(bp
, MISC_REGISTERS_GPIO_1
,
6968 MISC_REGISTERS_GPIO_OUTPUT_LOW
, port
);
6969 usleep_range(1000, 2000);
6970 bnx2x_set_gpio(bp
, MISC_REGISTERS_GPIO_1
,
6971 MISC_REGISTERS_GPIO_OUTPUT_HIGH
, port
);
6974 static void bnx2x_save_spirom_version(struct bnx2x
*bp
, u8 port
,
6975 u32 spirom_ver
, u32 ver_addr
)
6977 DP(NETIF_MSG_LINK
, "FW version 0x%x:0x%x for port %d\n",
6978 (u16
)(spirom_ver
>>16), (u16
)spirom_ver
, port
);
6981 REG_WR(bp
, ver_addr
, spirom_ver
);
6984 static void bnx2x_save_bcm_spirom_ver(struct bnx2x
*bp
,
6985 struct bnx2x_phy
*phy
,
6988 u16 fw_ver1
, fw_ver2
;
6990 bnx2x_cl45_read(bp
, phy
, MDIO_PMA_DEVAD
,
6991 MDIO_PMA_REG_ROM_VER1
, &fw_ver1
);
6992 bnx2x_cl45_read(bp
, phy
, MDIO_PMA_DEVAD
,
6993 MDIO_PMA_REG_ROM_VER2
, &fw_ver2
);
6994 bnx2x_save_spirom_version(bp
, port
, (u32
)(fw_ver1
<<16 | fw_ver2
),
6998 static void bnx2x_ext_phy_10G_an_resolve(struct bnx2x
*bp
,
6999 struct bnx2x_phy
*phy
,
7000 struct link_vars
*vars
)
7003 bnx2x_cl45_read(bp
, phy
,
7005 MDIO_AN_REG_STATUS
, &val
);
7006 bnx2x_cl45_read(bp
, phy
,
7008 MDIO_AN_REG_STATUS
, &val
);
7010 vars
->link_status
|= LINK_STATUS_AUTO_NEGOTIATE_COMPLETE
;
7011 if ((val
& (1<<0)) == 0)
7012 vars
->link_status
|= LINK_STATUS_PARALLEL_DETECTION_USED
;
7015 /******************************************************************/
7016 /* common BCM8073/BCM8727 PHY SECTION */
7017 /******************************************************************/
7018 static void bnx2x_8073_resolve_fc(struct bnx2x_phy
*phy
,
7019 struct link_params
*params
,
7020 struct link_vars
*vars
)
7022 struct bnx2x
*bp
= params
->bp
;
7023 if (phy
->req_line_speed
== SPEED_10
||
7024 phy
->req_line_speed
== SPEED_100
) {
7025 vars
->flow_ctrl
= phy
->req_flow_ctrl
;
7029 if (bnx2x_ext_phy_resolve_fc(phy
, params
, vars
) &&
7030 (vars
->flow_ctrl
== BNX2X_FLOW_CTRL_NONE
)) {
7032 u16 ld_pause
; /* local */
7033 u16 lp_pause
; /* link partner */
7034 bnx2x_cl45_read(bp
, phy
,
7036 MDIO_AN_REG_CL37_FC_LD
, &ld_pause
);
7038 bnx2x_cl45_read(bp
, phy
,
7040 MDIO_AN_REG_CL37_FC_LP
, &lp_pause
);
7041 pause_result
= (ld_pause
&
7042 MDIO_COMBO_IEEE0_AUTO_NEG_ADV_PAUSE_BOTH
) >> 5;
7043 pause_result
|= (lp_pause
&
7044 MDIO_COMBO_IEEE0_AUTO_NEG_ADV_PAUSE_BOTH
) >> 7;
7046 bnx2x_pause_resolve(vars
, pause_result
);
7047 DP(NETIF_MSG_LINK
, "Ext PHY CL37 pause result 0x%x\n",
7051 static int bnx2x_8073_8727_external_rom_boot(struct bnx2x
*bp
,
7052 struct bnx2x_phy
*phy
,
7056 u16 fw_ver1
, fw_msgout
;
7059 /* Boot port from external ROM */
7061 bnx2x_cl45_write(bp
, phy
,
7063 MDIO_PMA_REG_GEN_CTRL
,
7066 /* Ucode reboot and rst */
7067 bnx2x_cl45_write(bp
, phy
,
7069 MDIO_PMA_REG_GEN_CTRL
,
7072 bnx2x_cl45_write(bp
, phy
,
7074 MDIO_PMA_REG_MISC_CTRL1
, 0x0001);
7076 /* Reset internal microprocessor */
7077 bnx2x_cl45_write(bp
, phy
,
7079 MDIO_PMA_REG_GEN_CTRL
,
7080 MDIO_PMA_REG_GEN_CTRL_ROM_MICRO_RESET
);
7082 /* Release srst bit */
7083 bnx2x_cl45_write(bp
, phy
,
7085 MDIO_PMA_REG_GEN_CTRL
,
7086 MDIO_PMA_REG_GEN_CTRL_ROM_RESET_INTERNAL_MP
);
7088 /* Delay 100ms per the PHY specifications */
7091 /* 8073 sometimes taking longer to download */
7096 "bnx2x_8073_8727_external_rom_boot port %x:"
7097 "Download failed. fw version = 0x%x\n",
7103 bnx2x_cl45_read(bp
, phy
,
7105 MDIO_PMA_REG_ROM_VER1
, &fw_ver1
);
7106 bnx2x_cl45_read(bp
, phy
,
7108 MDIO_PMA_REG_M8051_MSGOUT_REG
, &fw_msgout
);
7110 usleep_range(1000, 2000);
7111 } while (fw_ver1
== 0 || fw_ver1
== 0x4321 ||
7112 ((fw_msgout
& 0xff) != 0x03 && (phy
->type
==
7113 PORT_HW_CFG_XGXS_EXT_PHY_TYPE_BCM8073
)));
7115 /* Clear ser_boot_ctl bit */
7116 bnx2x_cl45_write(bp
, phy
,
7118 MDIO_PMA_REG_MISC_CTRL1
, 0x0000);
7119 bnx2x_save_bcm_spirom_ver(bp
, phy
, port
);
7122 "bnx2x_8073_8727_external_rom_boot port %x:"
7123 "Download complete. fw version = 0x%x\n",
7129 /******************************************************************/
7130 /* BCM8073 PHY SECTION */
7131 /******************************************************************/
7132 static int bnx2x_8073_is_snr_needed(struct bnx2x
*bp
, struct bnx2x_phy
*phy
)
7134 /* This is only required for 8073A1, version 102 only */
7137 /* Read 8073 HW revision*/
7138 bnx2x_cl45_read(bp
, phy
,
7140 MDIO_PMA_REG_8073_CHIP_REV
, &val
);
7143 /* No need to workaround in 8073 A1 */
7147 bnx2x_cl45_read(bp
, phy
,
7149 MDIO_PMA_REG_ROM_VER2
, &val
);
7151 /* SNR should be applied only for version 0x102 */
7158 static int bnx2x_8073_xaui_wa(struct bnx2x
*bp
, struct bnx2x_phy
*phy
)
7160 u16 val
, cnt
, cnt1
;
7162 bnx2x_cl45_read(bp
, phy
,
7164 MDIO_PMA_REG_8073_CHIP_REV
, &val
);
7167 /* No need to workaround in 8073 A1 */
7170 /* XAUI workaround in 8073 A0: */
7172 /* After loading the boot ROM and restarting Autoneg, poll
7176 for (cnt
= 0; cnt
< 1000; cnt
++) {
7177 bnx2x_cl45_read(bp
, phy
,
7179 MDIO_PMA_REG_8073_SPEED_LINK_STATUS
,
7181 /* If bit [14] = 0 or bit [13] = 0, continue on with
7182 * system initialization (XAUI work-around not required, as
7183 * these bits indicate 2.5G or 1G link up).
7185 if (!(val
& (1<<14)) || !(val
& (1<<13))) {
7186 DP(NETIF_MSG_LINK
, "XAUI work-around not required\n");
7188 } else if (!(val
& (1<<15))) {
7189 DP(NETIF_MSG_LINK
, "bit 15 went off\n");
7190 /* If bit 15 is 0, then poll Dev1, Reg $C841 until it's
7191 * MSB (bit15) goes to 1 (indicating that the XAUI
7192 * workaround has completed), then continue on with
7193 * system initialization.
7195 for (cnt1
= 0; cnt1
< 1000; cnt1
++) {
7196 bnx2x_cl45_read(bp
, phy
,
7198 MDIO_PMA_REG_8073_XAUI_WA
, &val
);
7199 if (val
& (1<<15)) {
7201 "XAUI workaround has completed\n");
7204 usleep_range(3000, 6000);
7208 usleep_range(3000, 6000);
7210 DP(NETIF_MSG_LINK
, "Warning: XAUI work-around timeout !!!\n");
7214 static void bnx2x_807x_force_10G(struct bnx2x
*bp
, struct bnx2x_phy
*phy
)
7216 /* Force KR or KX */
7217 bnx2x_cl45_write(bp
, phy
,
7218 MDIO_PMA_DEVAD
, MDIO_PMA_REG_CTRL
, 0x2040);
7219 bnx2x_cl45_write(bp
, phy
,
7220 MDIO_PMA_DEVAD
, MDIO_PMA_REG_10G_CTRL2
, 0x000b);
7221 bnx2x_cl45_write(bp
, phy
,
7222 MDIO_PMA_DEVAD
, MDIO_PMA_REG_BCM_CTRL
, 0x0000);
7223 bnx2x_cl45_write(bp
, phy
,
7224 MDIO_AN_DEVAD
, MDIO_AN_REG_CTRL
, 0x0000);
7227 static void bnx2x_8073_set_pause_cl37(struct link_params
*params
,
7228 struct bnx2x_phy
*phy
,
7229 struct link_vars
*vars
)
7232 struct bnx2x
*bp
= params
->bp
;
7233 bnx2x_cl45_read(bp
, phy
,
7234 MDIO_AN_DEVAD
, MDIO_AN_REG_CL37_FC_LD
, &cl37_val
);
7236 cl37_val
&= ~MDIO_COMBO_IEEE0_AUTO_NEG_ADV_PAUSE_BOTH
;
7237 /* Please refer to Table 28B-3 of 802.3ab-1999 spec. */
7238 bnx2x_calc_ieee_aneg_adv(phy
, params
, &vars
->ieee_fc
);
7239 if ((vars
->ieee_fc
&
7240 MDIO_COMBO_IEEE0_AUTO_NEG_ADV_PAUSE_SYMMETRIC
) ==
7241 MDIO_COMBO_IEEE0_AUTO_NEG_ADV_PAUSE_SYMMETRIC
) {
7242 cl37_val
|= MDIO_COMBO_IEEE0_AUTO_NEG_ADV_PAUSE_SYMMETRIC
;
7244 if ((vars
->ieee_fc
&
7245 MDIO_COMBO_IEEE0_AUTO_NEG_ADV_PAUSE_ASYMMETRIC
) ==
7246 MDIO_COMBO_IEEE0_AUTO_NEG_ADV_PAUSE_ASYMMETRIC
) {
7247 cl37_val
|= MDIO_COMBO_IEEE0_AUTO_NEG_ADV_PAUSE_ASYMMETRIC
;
7249 if ((vars
->ieee_fc
&
7250 MDIO_COMBO_IEEE0_AUTO_NEG_ADV_PAUSE_BOTH
) ==
7251 MDIO_COMBO_IEEE0_AUTO_NEG_ADV_PAUSE_BOTH
) {
7252 cl37_val
|= MDIO_COMBO_IEEE0_AUTO_NEG_ADV_PAUSE_BOTH
;
7255 "Ext phy AN advertize cl37 0x%x\n", cl37_val
);
7257 bnx2x_cl45_write(bp
, phy
,
7258 MDIO_AN_DEVAD
, MDIO_AN_REG_CL37_FC_LD
, cl37_val
);
7262 static void bnx2x_8073_specific_func(struct bnx2x_phy
*phy
,
7263 struct link_params
*params
,
7266 struct bnx2x
*bp
= params
->bp
;
7270 bnx2x_cl45_write(bp
, phy
,
7271 MDIO_PMA_DEVAD
, MDIO_PMA_LASI_RXCTRL
, (1<<2));
7272 bnx2x_cl45_write(bp
, phy
,
7273 MDIO_PMA_DEVAD
, MDIO_PMA_LASI_CTRL
, 0x0004);
7278 static int bnx2x_8073_config_init(struct bnx2x_phy
*phy
,
7279 struct link_params
*params
,
7280 struct link_vars
*vars
)
7282 struct bnx2x
*bp
= params
->bp
;
7285 DP(NETIF_MSG_LINK
, "Init 8073\n");
7288 gpio_port
= BP_PATH(bp
);
7290 gpio_port
= params
->port
;
7291 /* Restore normal power mode*/
7292 bnx2x_set_gpio(bp
, MISC_REGISTERS_GPIO_2
,
7293 MISC_REGISTERS_GPIO_OUTPUT_HIGH
, gpio_port
);
7295 bnx2x_set_gpio(bp
, MISC_REGISTERS_GPIO_1
,
7296 MISC_REGISTERS_GPIO_OUTPUT_HIGH
, gpio_port
);
7298 bnx2x_8073_specific_func(phy
, params
, PHY_INIT
);
7299 bnx2x_8073_set_pause_cl37(params
, phy
, vars
);
7301 bnx2x_cl45_read(bp
, phy
,
7302 MDIO_PMA_DEVAD
, MDIO_PMA_REG_M8051_MSGOUT_REG
, &tmp1
);
7304 bnx2x_cl45_read(bp
, phy
,
7305 MDIO_PMA_DEVAD
, MDIO_PMA_LASI_RXSTAT
, &tmp1
);
7307 DP(NETIF_MSG_LINK
, "Before rom RX_ALARM(port1): 0x%x\n", tmp1
);
7309 /* Swap polarity if required - Must be done only in non-1G mode */
7310 if (params
->lane_config
& PORT_HW_CFG_SWAP_PHY_POLARITY_ENABLED
) {
7311 /* Configure the 8073 to swap _P and _N of the KR lines */
7312 DP(NETIF_MSG_LINK
, "Swapping polarity for the 8073\n");
7313 /* 10G Rx/Tx and 1G Tx signal polarity swap */
7314 bnx2x_cl45_read(bp
, phy
,
7316 MDIO_PMA_REG_8073_OPT_DIGITAL_CTRL
, &val
);
7317 bnx2x_cl45_write(bp
, phy
,
7319 MDIO_PMA_REG_8073_OPT_DIGITAL_CTRL
,
7324 /* Enable CL37 BAM */
7325 if (REG_RD(bp
, params
->shmem_base
+
7326 offsetof(struct shmem_region
, dev_info
.
7327 port_hw_config
[params
->port
].default_cfg
)) &
7328 PORT_HW_CFG_ENABLE_BAM_ON_KR_ENABLED
) {
7330 bnx2x_cl45_read(bp
, phy
,
7332 MDIO_AN_REG_8073_BAM
, &val
);
7333 bnx2x_cl45_write(bp
, phy
,
7335 MDIO_AN_REG_8073_BAM
, val
| 1);
7336 DP(NETIF_MSG_LINK
, "Enable CL37 BAM on KR\n");
7338 if (params
->loopback_mode
== LOOPBACK_EXT
) {
7339 bnx2x_807x_force_10G(bp
, phy
);
7340 DP(NETIF_MSG_LINK
, "Forced speed 10G on 807X\n");
7343 bnx2x_cl45_write(bp
, phy
,
7344 MDIO_PMA_DEVAD
, MDIO_PMA_REG_BCM_CTRL
, 0x0002);
7346 if (phy
->req_line_speed
!= SPEED_AUTO_NEG
) {
7347 if (phy
->req_line_speed
== SPEED_10000
) {
7349 } else if (phy
->req_line_speed
== SPEED_2500
) {
7351 /* Note that 2.5G works only when used with 1G
7358 if (phy
->speed_cap_mask
&
7359 PORT_HW_CFG_SPEED_CAPABILITY_D0_10G
)
7362 /* Note that 2.5G works only when used with 1G advertisement */
7363 if (phy
->speed_cap_mask
&
7364 (PORT_HW_CFG_SPEED_CAPABILITY_D0_1G
|
7365 PORT_HW_CFG_SPEED_CAPABILITY_D0_2_5G
))
7367 DP(NETIF_MSG_LINK
, "807x autoneg val = 0x%x\n", val
);
7370 bnx2x_cl45_write(bp
, phy
, MDIO_AN_DEVAD
, MDIO_AN_REG_ADV
, val
);
7371 bnx2x_cl45_read(bp
, phy
, MDIO_AN_DEVAD
, MDIO_AN_REG_8073_2_5G
, &tmp1
);
7373 if (((phy
->speed_cap_mask
& PORT_HW_CFG_SPEED_CAPABILITY_D0_2_5G
) &&
7374 (phy
->req_line_speed
== SPEED_AUTO_NEG
)) ||
7375 (phy
->req_line_speed
== SPEED_2500
)) {
7377 /* Allow 2.5G for A1 and above */
7378 bnx2x_cl45_read(bp
, phy
,
7379 MDIO_PMA_DEVAD
, MDIO_PMA_REG_8073_CHIP_REV
,
7381 DP(NETIF_MSG_LINK
, "Add 2.5G\n");
7387 DP(NETIF_MSG_LINK
, "Disable 2.5G\n");
7391 bnx2x_cl45_write(bp
, phy
, MDIO_AN_DEVAD
, MDIO_AN_REG_8073_2_5G
, tmp1
);
7392 /* Add support for CL37 (passive mode) II */
7394 bnx2x_cl45_read(bp
, phy
, MDIO_AN_DEVAD
, MDIO_AN_REG_CL37_FC_LD
, &tmp1
);
7395 bnx2x_cl45_write(bp
, phy
, MDIO_AN_DEVAD
, MDIO_AN_REG_CL37_FC_LD
,
7396 (tmp1
| ((phy
->req_duplex
== DUPLEX_FULL
) ?
7399 /* Add support for CL37 (passive mode) III */
7400 bnx2x_cl45_write(bp
, phy
, MDIO_AN_DEVAD
, MDIO_AN_REG_CL37_AN
, 0x1000);
7402 /* The SNR will improve about 2db by changing BW and FEE main
7403 * tap. Rest commands are executed after link is up
7404 * Change FFE main cursor to 5 in EDC register
7406 if (bnx2x_8073_is_snr_needed(bp
, phy
))
7407 bnx2x_cl45_write(bp
, phy
,
7408 MDIO_PMA_DEVAD
, MDIO_PMA_REG_EDC_FFE_MAIN
,
7411 /* Enable FEC (Forware Error Correction) Request in the AN */
7412 bnx2x_cl45_read(bp
, phy
, MDIO_AN_DEVAD
, MDIO_AN_REG_ADV2
, &tmp1
);
7414 bnx2x_cl45_write(bp
, phy
, MDIO_AN_DEVAD
, MDIO_AN_REG_ADV2
, tmp1
);
7416 bnx2x_ext_phy_set_pause(params
, phy
, vars
);
7418 /* Restart autoneg */
7420 bnx2x_cl45_write(bp
, phy
, MDIO_AN_DEVAD
, MDIO_AN_REG_CTRL
, 0x1200);
7421 DP(NETIF_MSG_LINK
, "807x Autoneg Restart: Advertise 1G=%x, 10G=%x\n",
7422 ((val
& (1<<5)) > 0), ((val
& (1<<7)) > 0));
7426 static u8
bnx2x_8073_read_status(struct bnx2x_phy
*phy
,
7427 struct link_params
*params
,
7428 struct link_vars
*vars
)
7430 struct bnx2x
*bp
= params
->bp
;
7433 u16 link_status
= 0;
7434 u16 an1000_status
= 0;
7436 bnx2x_cl45_read(bp
, phy
,
7437 MDIO_PMA_DEVAD
, MDIO_PMA_LASI_STAT
, &val1
);
7439 DP(NETIF_MSG_LINK
, "8703 LASI status 0x%x\n", val1
);
7441 /* Clear the interrupt LASI status register */
7442 bnx2x_cl45_read(bp
, phy
,
7443 MDIO_PCS_DEVAD
, MDIO_PCS_REG_STATUS
, &val2
);
7444 bnx2x_cl45_read(bp
, phy
,
7445 MDIO_PCS_DEVAD
, MDIO_PCS_REG_STATUS
, &val1
);
7446 DP(NETIF_MSG_LINK
, "807x PCS status 0x%x->0x%x\n", val2
, val1
);
7448 bnx2x_cl45_read(bp
, phy
,
7449 MDIO_PMA_DEVAD
, MDIO_PMA_REG_M8051_MSGOUT_REG
, &val1
);
7451 /* Check the LASI */
7452 bnx2x_cl45_read(bp
, phy
,
7453 MDIO_PMA_DEVAD
, MDIO_PMA_LASI_RXSTAT
, &val2
);
7455 DP(NETIF_MSG_LINK
, "KR 0x9003 0x%x\n", val2
);
7457 /* Check the link status */
7458 bnx2x_cl45_read(bp
, phy
,
7459 MDIO_PCS_DEVAD
, MDIO_PCS_REG_STATUS
, &val2
);
7460 DP(NETIF_MSG_LINK
, "KR PCS status 0x%x\n", val2
);
7462 bnx2x_cl45_read(bp
, phy
,
7463 MDIO_PMA_DEVAD
, MDIO_PMA_REG_STATUS
, &val2
);
7464 bnx2x_cl45_read(bp
, phy
,
7465 MDIO_PMA_DEVAD
, MDIO_PMA_REG_STATUS
, &val1
);
7466 link_up
= ((val1
& 4) == 4);
7467 DP(NETIF_MSG_LINK
, "PMA_REG_STATUS=0x%x\n", val1
);
7470 ((phy
->req_line_speed
!= SPEED_10000
))) {
7471 if (bnx2x_8073_xaui_wa(bp
, phy
) != 0)
7474 bnx2x_cl45_read(bp
, phy
,
7475 MDIO_AN_DEVAD
, MDIO_AN_REG_LINK_STATUS
, &an1000_status
);
7476 bnx2x_cl45_read(bp
, phy
,
7477 MDIO_AN_DEVAD
, MDIO_AN_REG_LINK_STATUS
, &an1000_status
);
7479 /* Check the link status on 1.1.2 */
7480 bnx2x_cl45_read(bp
, phy
,
7481 MDIO_PMA_DEVAD
, MDIO_PMA_REG_STATUS
, &val2
);
7482 bnx2x_cl45_read(bp
, phy
,
7483 MDIO_PMA_DEVAD
, MDIO_PMA_REG_STATUS
, &val1
);
7484 DP(NETIF_MSG_LINK
, "KR PMA status 0x%x->0x%x,"
7485 "an_link_status=0x%x\n", val2
, val1
, an1000_status
);
7487 link_up
= (((val1
& 4) == 4) || (an1000_status
& (1<<1)));
7488 if (link_up
&& bnx2x_8073_is_snr_needed(bp
, phy
)) {
7489 /* The SNR will improve about 2dbby changing the BW and FEE main
7490 * tap. The 1st write to change FFE main tap is set before
7491 * restart AN. Change PLL Bandwidth in EDC register
7493 bnx2x_cl45_write(bp
, phy
,
7494 MDIO_PMA_DEVAD
, MDIO_PMA_REG_PLL_BANDWIDTH
,
7497 /* Change CDR Bandwidth in EDC register */
7498 bnx2x_cl45_write(bp
, phy
,
7499 MDIO_PMA_DEVAD
, MDIO_PMA_REG_CDR_BANDWIDTH
,
7502 bnx2x_cl45_read(bp
, phy
,
7503 MDIO_PMA_DEVAD
, MDIO_PMA_REG_8073_SPEED_LINK_STATUS
,
7506 /* Bits 0..2 --> speed detected, bits 13..15--> link is down */
7507 if ((link_status
& (1<<2)) && (!(link_status
& (1<<15)))) {
7509 vars
->line_speed
= SPEED_10000
;
7510 DP(NETIF_MSG_LINK
, "port %x: External link up in 10G\n",
7512 } else if ((link_status
& (1<<1)) && (!(link_status
& (1<<14)))) {
7514 vars
->line_speed
= SPEED_2500
;
7515 DP(NETIF_MSG_LINK
, "port %x: External link up in 2.5G\n",
7517 } else if ((link_status
& (1<<0)) && (!(link_status
& (1<<13)))) {
7519 vars
->line_speed
= SPEED_1000
;
7520 DP(NETIF_MSG_LINK
, "port %x: External link up in 1G\n",
7524 DP(NETIF_MSG_LINK
, "port %x: External link is down\n",
7529 /* Swap polarity if required */
7530 if (params
->lane_config
&
7531 PORT_HW_CFG_SWAP_PHY_POLARITY_ENABLED
) {
7532 /* Configure the 8073 to swap P and N of the KR lines */
7533 bnx2x_cl45_read(bp
, phy
,
7535 MDIO_XS_REG_8073_RX_CTRL_PCIE
, &val1
);
7536 /* Set bit 3 to invert Rx in 1G mode and clear this bit
7537 * when it`s in 10G mode.
7539 if (vars
->line_speed
== SPEED_1000
) {
7540 DP(NETIF_MSG_LINK
, "Swapping 1G polarity for"
7546 bnx2x_cl45_write(bp
, phy
,
7548 MDIO_XS_REG_8073_RX_CTRL_PCIE
,
7551 bnx2x_ext_phy_10G_an_resolve(bp
, phy
, vars
);
7552 bnx2x_8073_resolve_fc(phy
, params
, vars
);
7553 vars
->duplex
= DUPLEX_FULL
;
7556 if (vars
->link_status
& LINK_STATUS_AUTO_NEGOTIATE_COMPLETE
) {
7557 bnx2x_cl45_read(bp
, phy
, MDIO_AN_DEVAD
,
7558 MDIO_AN_REG_LP_AUTO_NEG2
, &val1
);
7561 vars
->link_status
|=
7562 LINK_STATUS_LINK_PARTNER_1000TFD_CAPABLE
;
7564 vars
->link_status
|=
7565 LINK_STATUS_LINK_PARTNER_10GXFD_CAPABLE
;
7571 static void bnx2x_8073_link_reset(struct bnx2x_phy
*phy
,
7572 struct link_params
*params
)
7574 struct bnx2x
*bp
= params
->bp
;
7577 gpio_port
= BP_PATH(bp
);
7579 gpio_port
= params
->port
;
7580 DP(NETIF_MSG_LINK
, "Setting 8073 port %d into low power mode\n",
7582 bnx2x_set_gpio(bp
, MISC_REGISTERS_GPIO_2
,
7583 MISC_REGISTERS_GPIO_OUTPUT_LOW
,
7587 /******************************************************************/
7588 /* BCM8705 PHY SECTION */
7589 /******************************************************************/
7590 static int bnx2x_8705_config_init(struct bnx2x_phy
*phy
,
7591 struct link_params
*params
,
7592 struct link_vars
*vars
)
7594 struct bnx2x
*bp
= params
->bp
;
7595 DP(NETIF_MSG_LINK
, "init 8705\n");
7596 /* Restore normal power mode*/
7597 bnx2x_set_gpio(bp
, MISC_REGISTERS_GPIO_2
,
7598 MISC_REGISTERS_GPIO_OUTPUT_HIGH
, params
->port
);
7600 bnx2x_ext_phy_hw_reset(bp
, params
->port
);
7601 bnx2x_cl45_write(bp
, phy
, MDIO_PMA_DEVAD
, MDIO_PMA_REG_CTRL
, 0xa040);
7602 bnx2x_wait_reset_complete(bp
, phy
, params
);
7604 bnx2x_cl45_write(bp
, phy
,
7605 MDIO_PMA_DEVAD
, MDIO_PMA_REG_MISC_CTRL
, 0x8288);
7606 bnx2x_cl45_write(bp
, phy
,
7607 MDIO_PMA_DEVAD
, MDIO_PMA_REG_PHY_IDENTIFIER
, 0x7fbf);
7608 bnx2x_cl45_write(bp
, phy
,
7609 MDIO_PMA_DEVAD
, MDIO_PMA_REG_CMU_PLL_BYPASS
, 0x0100);
7610 bnx2x_cl45_write(bp
, phy
,
7611 MDIO_WIS_DEVAD
, MDIO_WIS_REG_LASI_CNTL
, 0x1);
7612 /* BCM8705 doesn't have microcode, hence the 0 */
7613 bnx2x_save_spirom_version(bp
, params
->port
, params
->shmem_base
, 0);
7617 static u8
bnx2x_8705_read_status(struct bnx2x_phy
*phy
,
7618 struct link_params
*params
,
7619 struct link_vars
*vars
)
7623 struct bnx2x
*bp
= params
->bp
;
7624 DP(NETIF_MSG_LINK
, "read status 8705\n");
7625 bnx2x_cl45_read(bp
, phy
,
7626 MDIO_WIS_DEVAD
, MDIO_WIS_REG_LASI_STATUS
, &val1
);
7627 DP(NETIF_MSG_LINK
, "8705 LASI status 0x%x\n", val1
);
7629 bnx2x_cl45_read(bp
, phy
,
7630 MDIO_WIS_DEVAD
, MDIO_WIS_REG_LASI_STATUS
, &val1
);
7631 DP(NETIF_MSG_LINK
, "8705 LASI status 0x%x\n", val1
);
7633 bnx2x_cl45_read(bp
, phy
,
7634 MDIO_PMA_DEVAD
, MDIO_PMA_REG_RX_SD
, &rx_sd
);
7636 bnx2x_cl45_read(bp
, phy
,
7637 MDIO_PMA_DEVAD
, 0xc809, &val1
);
7638 bnx2x_cl45_read(bp
, phy
,
7639 MDIO_PMA_DEVAD
, 0xc809, &val1
);
7641 DP(NETIF_MSG_LINK
, "8705 1.c809 val=0x%x\n", val1
);
7642 link_up
= ((rx_sd
& 0x1) && (val1
& (1<<9)) && ((val1
& (1<<8)) == 0));
7644 vars
->line_speed
= SPEED_10000
;
7645 bnx2x_ext_phy_resolve_fc(phy
, params
, vars
);
7650 /******************************************************************/
7651 /* SFP+ module Section */
7652 /******************************************************************/
7653 static void bnx2x_set_disable_pmd_transmit(struct link_params
*params
,
7654 struct bnx2x_phy
*phy
,
7657 struct bnx2x
*bp
= params
->bp
;
7658 /* Disable transmitter only for bootcodes which can enable it afterwards
7662 if (params
->feature_config_flags
&
7663 FEATURE_CONFIG_BC_SUPPORTS_SFP_TX_DISABLED
)
7664 DP(NETIF_MSG_LINK
, "Disabling PMD transmitter\n");
7666 DP(NETIF_MSG_LINK
, "NOT disabling PMD transmitter\n");
7670 DP(NETIF_MSG_LINK
, "Enabling PMD transmitter\n");
7671 bnx2x_cl45_write(bp
, phy
,
7673 MDIO_PMA_REG_TX_DISABLE
, pmd_dis
);
7676 static u8
bnx2x_get_gpio_port(struct link_params
*params
)
7679 u32 swap_val
, swap_override
;
7680 struct bnx2x
*bp
= params
->bp
;
7682 gpio_port
= BP_PATH(bp
);
7684 gpio_port
= params
->port
;
7685 swap_val
= REG_RD(bp
, NIG_REG_PORT_SWAP
);
7686 swap_override
= REG_RD(bp
, NIG_REG_STRAP_OVERRIDE
);
7687 return gpio_port
^ (swap_val
&& swap_override
);
7690 static void bnx2x_sfp_e1e2_set_transmitter(struct link_params
*params
,
7691 struct bnx2x_phy
*phy
,
7695 u8 port
= params
->port
;
7696 struct bnx2x
*bp
= params
->bp
;
7699 /* Disable/Enable transmitter ( TX laser of the SFP+ module.)*/
7700 tx_en_mode
= REG_RD(bp
, params
->shmem_base
+
7701 offsetof(struct shmem_region
,
7702 dev_info
.port_hw_config
[port
].sfp_ctrl
)) &
7703 PORT_HW_CFG_TX_LASER_MASK
;
7704 DP(NETIF_MSG_LINK
, "Setting transmitter tx_en=%x for port %x "
7705 "mode = %x\n", tx_en
, port
, tx_en_mode
);
7706 switch (tx_en_mode
) {
7707 case PORT_HW_CFG_TX_LASER_MDIO
:
7709 bnx2x_cl45_read(bp
, phy
,
7711 MDIO_PMA_REG_PHY_IDENTIFIER
,
7719 bnx2x_cl45_write(bp
, phy
,
7721 MDIO_PMA_REG_PHY_IDENTIFIER
,
7724 case PORT_HW_CFG_TX_LASER_GPIO0
:
7725 case PORT_HW_CFG_TX_LASER_GPIO1
:
7726 case PORT_HW_CFG_TX_LASER_GPIO2
:
7727 case PORT_HW_CFG_TX_LASER_GPIO3
:
7730 u8 gpio_port
, gpio_mode
;
7732 gpio_mode
= MISC_REGISTERS_GPIO_OUTPUT_HIGH
;
7734 gpio_mode
= MISC_REGISTERS_GPIO_OUTPUT_LOW
;
7736 gpio_pin
= tx_en_mode
- PORT_HW_CFG_TX_LASER_GPIO0
;
7737 gpio_port
= bnx2x_get_gpio_port(params
);
7738 bnx2x_set_gpio(bp
, gpio_pin
, gpio_mode
, gpio_port
);
7742 DP(NETIF_MSG_LINK
, "Invalid TX_LASER_MDIO 0x%x\n", tx_en_mode
);
7747 static void bnx2x_sfp_set_transmitter(struct link_params
*params
,
7748 struct bnx2x_phy
*phy
,
7751 struct bnx2x
*bp
= params
->bp
;
7752 DP(NETIF_MSG_LINK
, "Setting SFP+ transmitter to %d\n", tx_en
);
7754 bnx2x_sfp_e3_set_transmitter(params
, phy
, tx_en
);
7756 bnx2x_sfp_e1e2_set_transmitter(params
, phy
, tx_en
);
7759 static int bnx2x_8726_read_sfp_module_eeprom(struct bnx2x_phy
*phy
,
7760 struct link_params
*params
,
7761 u16 addr
, u8 byte_cnt
, u8
*o_buf
)
7763 struct bnx2x
*bp
= params
->bp
;
7766 if (byte_cnt
> SFP_EEPROM_PAGE_SIZE
) {
7768 "Reading from eeprom is limited to 0xf\n");
7771 /* Set the read command byte count */
7772 bnx2x_cl45_write(bp
, phy
,
7773 MDIO_PMA_DEVAD
, MDIO_PMA_REG_SFP_TWO_WIRE_BYTE_CNT
,
7774 (byte_cnt
| 0xa000));
7776 /* Set the read command address */
7777 bnx2x_cl45_write(bp
, phy
,
7778 MDIO_PMA_DEVAD
, MDIO_PMA_REG_SFP_TWO_WIRE_MEM_ADDR
,
7781 /* Activate read command */
7782 bnx2x_cl45_write(bp
, phy
,
7783 MDIO_PMA_DEVAD
, MDIO_PMA_REG_SFP_TWO_WIRE_CTRL
,
7786 /* Wait up to 500us for command complete status */
7787 for (i
= 0; i
< 100; i
++) {
7788 bnx2x_cl45_read(bp
, phy
,
7790 MDIO_PMA_REG_SFP_TWO_WIRE_CTRL
, &val
);
7791 if ((val
& MDIO_PMA_REG_SFP_TWO_WIRE_CTRL_STATUS_MASK
) ==
7792 MDIO_PMA_REG_SFP_TWO_WIRE_STATUS_COMPLETE
)
7797 if ((val
& MDIO_PMA_REG_SFP_TWO_WIRE_CTRL_STATUS_MASK
) !=
7798 MDIO_PMA_REG_SFP_TWO_WIRE_STATUS_COMPLETE
) {
7800 "Got bad status 0x%x when reading from SFP+ EEPROM\n",
7801 (val
& MDIO_PMA_REG_SFP_TWO_WIRE_CTRL_STATUS_MASK
));
7805 /* Read the buffer */
7806 for (i
= 0; i
< byte_cnt
; i
++) {
7807 bnx2x_cl45_read(bp
, phy
,
7809 MDIO_PMA_REG_8726_TWO_WIRE_DATA_BUF
+ i
, &val
);
7810 o_buf
[i
] = (u8
)(val
& MDIO_PMA_REG_8726_TWO_WIRE_DATA_MASK
);
7813 for (i
= 0; i
< 100; i
++) {
7814 bnx2x_cl45_read(bp
, phy
,
7816 MDIO_PMA_REG_SFP_TWO_WIRE_CTRL
, &val
);
7817 if ((val
& MDIO_PMA_REG_SFP_TWO_WIRE_CTRL_STATUS_MASK
) ==
7818 MDIO_PMA_REG_SFP_TWO_WIRE_STATUS_IDLE
)
7820 usleep_range(1000, 2000);
7825 static void bnx2x_warpcore_power_module(struct link_params
*params
,
7829 struct bnx2x
*bp
= params
->bp
;
7831 pin_cfg
= (REG_RD(bp
, params
->shmem_base
+
7832 offsetof(struct shmem_region
,
7833 dev_info
.port_hw_config
[params
->port
].e3_sfp_ctrl
)) &
7834 PORT_HW_CFG_E3_PWR_DIS_MASK
) >>
7835 PORT_HW_CFG_E3_PWR_DIS_SHIFT
;
7837 if (pin_cfg
== PIN_CFG_NA
)
7839 DP(NETIF_MSG_LINK
, "Setting SFP+ module power to %d using pin cfg %d\n",
7841 /* Low ==> corresponding SFP+ module is powered
7842 * high ==> the SFP+ module is powered down
7844 bnx2x_set_cfg_pin(bp
, pin_cfg
, power
^ 1);
7846 static int bnx2x_warpcore_read_sfp_module_eeprom(struct bnx2x_phy
*phy
,
7847 struct link_params
*params
,
7848 u16 addr
, u8 byte_cnt
,
7849 u8
*o_buf
, u8 is_init
)
7852 u8 i
, j
= 0, cnt
= 0;
7855 struct bnx2x
*bp
= params
->bp
;
7857 if (byte_cnt
> SFP_EEPROM_PAGE_SIZE
) {
7859 "Reading from eeprom is limited to 16 bytes\n");
7863 /* 4 byte aligned address */
7864 addr32
= addr
& (~0x3);
7866 if ((!is_init
) && (cnt
== I2C_WA_PWR_ITER
)) {
7867 bnx2x_warpcore_power_module(params
, 0);
7868 /* Note that 100us are not enough here */
7869 usleep_range(1000, 2000);
7870 bnx2x_warpcore_power_module(params
, 1);
7872 rc
= bnx2x_bsc_read(params
, phy
, 0xa0, addr32
, 0, byte_cnt
,
7874 } while ((rc
!= 0) && (++cnt
< I2C_WA_RETRY_CNT
));
7877 for (i
= (addr
- addr32
); i
< byte_cnt
+ (addr
- addr32
); i
++) {
7878 o_buf
[j
] = *((u8
*)data_array
+ i
);
7886 static int bnx2x_8727_read_sfp_module_eeprom(struct bnx2x_phy
*phy
,
7887 struct link_params
*params
,
7888 u16 addr
, u8 byte_cnt
, u8
*o_buf
)
7890 struct bnx2x
*bp
= params
->bp
;
7893 if (byte_cnt
> SFP_EEPROM_PAGE_SIZE
) {
7895 "Reading from eeprom is limited to 0xf\n");
7899 /* Need to read from 1.8000 to clear it */
7900 bnx2x_cl45_read(bp
, phy
,
7902 MDIO_PMA_REG_SFP_TWO_WIRE_CTRL
,
7905 /* Set the read command byte count */
7906 bnx2x_cl45_write(bp
, phy
,
7908 MDIO_PMA_REG_SFP_TWO_WIRE_BYTE_CNT
,
7909 ((byte_cnt
< 2) ? 2 : byte_cnt
));
7911 /* Set the read command address */
7912 bnx2x_cl45_write(bp
, phy
,
7914 MDIO_PMA_REG_SFP_TWO_WIRE_MEM_ADDR
,
7916 /* Set the destination address */
7917 bnx2x_cl45_write(bp
, phy
,
7920 MDIO_PMA_REG_8727_TWO_WIRE_DATA_BUF
);
7922 /* Activate read command */
7923 bnx2x_cl45_write(bp
, phy
,
7925 MDIO_PMA_REG_SFP_TWO_WIRE_CTRL
,
7927 /* Wait appropriate time for two-wire command to finish before
7928 * polling the status register
7930 usleep_range(1000, 2000);
7932 /* Wait up to 500us for command complete status */
7933 for (i
= 0; i
< 100; i
++) {
7934 bnx2x_cl45_read(bp
, phy
,
7936 MDIO_PMA_REG_SFP_TWO_WIRE_CTRL
, &val
);
7937 if ((val
& MDIO_PMA_REG_SFP_TWO_WIRE_CTRL_STATUS_MASK
) ==
7938 MDIO_PMA_REG_SFP_TWO_WIRE_STATUS_COMPLETE
)
7943 if ((val
& MDIO_PMA_REG_SFP_TWO_WIRE_CTRL_STATUS_MASK
) !=
7944 MDIO_PMA_REG_SFP_TWO_WIRE_STATUS_COMPLETE
) {
7946 "Got bad status 0x%x when reading from SFP+ EEPROM\n",
7947 (val
& MDIO_PMA_REG_SFP_TWO_WIRE_CTRL_STATUS_MASK
));
7951 /* Read the buffer */
7952 for (i
= 0; i
< byte_cnt
; i
++) {
7953 bnx2x_cl45_read(bp
, phy
,
7955 MDIO_PMA_REG_8727_TWO_WIRE_DATA_BUF
+ i
, &val
);
7956 o_buf
[i
] = (u8
)(val
& MDIO_PMA_REG_8727_TWO_WIRE_DATA_MASK
);
7959 for (i
= 0; i
< 100; i
++) {
7960 bnx2x_cl45_read(bp
, phy
,
7962 MDIO_PMA_REG_SFP_TWO_WIRE_CTRL
, &val
);
7963 if ((val
& MDIO_PMA_REG_SFP_TWO_WIRE_CTRL_STATUS_MASK
) ==
7964 MDIO_PMA_REG_SFP_TWO_WIRE_STATUS_IDLE
)
7966 usleep_range(1000, 2000);
7972 int bnx2x_read_sfp_module_eeprom(struct bnx2x_phy
*phy
,
7973 struct link_params
*params
, u16 addr
,
7974 u8 byte_cnt
, u8
*o_buf
)
7976 int rc
= -EOPNOTSUPP
;
7977 switch (phy
->type
) {
7978 case PORT_HW_CFG_XGXS_EXT_PHY_TYPE_BCM8726
:
7979 rc
= bnx2x_8726_read_sfp_module_eeprom(phy
, params
, addr
,
7982 case PORT_HW_CFG_XGXS_EXT_PHY_TYPE_BCM8727
:
7983 case PORT_HW_CFG_XGXS_EXT_PHY_TYPE_BCM8722
:
7984 rc
= bnx2x_8727_read_sfp_module_eeprom(phy
, params
, addr
,
7987 case PORT_HW_CFG_XGXS_EXT_PHY_TYPE_DIRECT
:
7988 rc
= bnx2x_warpcore_read_sfp_module_eeprom(phy
, params
, addr
,
7989 byte_cnt
, o_buf
, 0);
7995 static int bnx2x_get_edc_mode(struct bnx2x_phy
*phy
,
7996 struct link_params
*params
,
7999 struct bnx2x
*bp
= params
->bp
;
8000 u32 sync_offset
= 0, phy_idx
, media_types
;
8001 u8 gport
, val
[2], check_limiting_mode
= 0;
8002 *edc_mode
= EDC_MODE_LIMITING
;
8003 phy
->media_type
= ETH_PHY_UNSPECIFIED
;
8004 /* First check for copper cable */
8005 if (bnx2x_read_sfp_module_eeprom(phy
,
8007 SFP_EEPROM_CON_TYPE_ADDR
,
8010 DP(NETIF_MSG_LINK
, "Failed to read from SFP+ module EEPROM\n");
8015 case SFP_EEPROM_CON_TYPE_VAL_COPPER
:
8017 u8 copper_module_type
;
8018 phy
->media_type
= ETH_PHY_DA_TWINAX
;
8019 /* Check if its active cable (includes SFP+ module)
8022 if (bnx2x_read_sfp_module_eeprom(phy
,
8024 SFP_EEPROM_FC_TX_TECH_ADDR
,
8026 &copper_module_type
) != 0) {
8028 "Failed to read copper-cable-type"
8029 " from SFP+ EEPROM\n");
8033 if (copper_module_type
&
8034 SFP_EEPROM_FC_TX_TECH_BITMASK_COPPER_ACTIVE
) {
8035 DP(NETIF_MSG_LINK
, "Active Copper cable detected\n");
8036 check_limiting_mode
= 1;
8037 } else if (copper_module_type
&
8038 SFP_EEPROM_FC_TX_TECH_BITMASK_COPPER_PASSIVE
) {
8040 "Passive Copper cable detected\n");
8042 EDC_MODE_PASSIVE_DAC
;
8045 "Unknown copper-cable-type 0x%x !!!\n",
8046 copper_module_type
);
8051 case SFP_EEPROM_CON_TYPE_VAL_LC
:
8052 check_limiting_mode
= 1;
8053 if ((val
[1] & (SFP_EEPROM_COMP_CODE_SR_MASK
|
8054 SFP_EEPROM_COMP_CODE_LR_MASK
|
8055 SFP_EEPROM_COMP_CODE_LRM_MASK
)) == 0) {
8056 DP(NETIF_MSG_LINK
, "1G Optic module detected\n");
8057 gport
= params
->port
;
8058 phy
->media_type
= ETH_PHY_SFP_1G_FIBER
;
8059 phy
->req_line_speed
= SPEED_1000
;
8060 if (!CHIP_IS_E1x(bp
))
8061 gport
= BP_PATH(bp
) + (params
->port
<< 1);
8062 netdev_err(bp
->dev
, "Warning: Link speed was forced to 1000Mbps."
8063 " Current SFP module in port %d is not"
8064 " compliant with 10G Ethernet\n",
8067 int idx
, cfg_idx
= 0;
8068 DP(NETIF_MSG_LINK
, "10G Optic module detected\n");
8069 for (idx
= INT_PHY
; idx
< MAX_PHYS
; idx
++) {
8070 if (params
->phy
[idx
].type
== phy
->type
) {
8071 cfg_idx
= LINK_CONFIG_IDX(idx
);
8075 phy
->media_type
= ETH_PHY_SFPP_10G_FIBER
;
8076 phy
->req_line_speed
= params
->req_line_speed
[cfg_idx
];
8080 DP(NETIF_MSG_LINK
, "Unable to determine module type 0x%x !!!\n",
8084 sync_offset
= params
->shmem_base
+
8085 offsetof(struct shmem_region
,
8086 dev_info
.port_hw_config
[params
->port
].media_type
);
8087 media_types
= REG_RD(bp
, sync_offset
);
8088 /* Update media type for non-PMF sync */
8089 for (phy_idx
= INT_PHY
; phy_idx
< MAX_PHYS
; phy_idx
++) {
8090 if (&(params
->phy
[phy_idx
]) == phy
) {
8091 media_types
&= ~(PORT_HW_CFG_MEDIA_TYPE_PHY0_MASK
<<
8092 (PORT_HW_CFG_MEDIA_TYPE_PHY1_SHIFT
* phy_idx
));
8093 media_types
|= ((phy
->media_type
&
8094 PORT_HW_CFG_MEDIA_TYPE_PHY0_MASK
) <<
8095 (PORT_HW_CFG_MEDIA_TYPE_PHY1_SHIFT
* phy_idx
));
8099 REG_WR(bp
, sync_offset
, media_types
);
8100 if (check_limiting_mode
) {
8101 u8 options
[SFP_EEPROM_OPTIONS_SIZE
];
8102 if (bnx2x_read_sfp_module_eeprom(phy
,
8104 SFP_EEPROM_OPTIONS_ADDR
,
8105 SFP_EEPROM_OPTIONS_SIZE
,
8108 "Failed to read Option field from module EEPROM\n");
8111 if ((options
[0] & SFP_EEPROM_OPTIONS_LINEAR_RX_OUT_MASK
))
8112 *edc_mode
= EDC_MODE_LINEAR
;
8114 *edc_mode
= EDC_MODE_LIMITING
;
8116 DP(NETIF_MSG_LINK
, "EDC mode is set to 0x%x\n", *edc_mode
);
8119 /* This function read the relevant field from the module (SFP+), and verify it
8120 * is compliant with this board
8122 static int bnx2x_verify_sfp_module(struct bnx2x_phy
*phy
,
8123 struct link_params
*params
)
8125 struct bnx2x
*bp
= params
->bp
;
8127 u32 fw_resp
, fw_cmd_param
;
8128 char vendor_name
[SFP_EEPROM_VENDOR_NAME_SIZE
+1];
8129 char vendor_pn
[SFP_EEPROM_PART_NO_SIZE
+1];
8130 phy
->flags
&= ~FLAGS_SFP_NOT_APPROVED
;
8131 val
= REG_RD(bp
, params
->shmem_base
+
8132 offsetof(struct shmem_region
, dev_info
.
8133 port_feature_config
[params
->port
].config
));
8134 if ((val
& PORT_FEAT_CFG_OPT_MDL_ENFRCMNT_MASK
) ==
8135 PORT_FEAT_CFG_OPT_MDL_ENFRCMNT_NO_ENFORCEMENT
) {
8136 DP(NETIF_MSG_LINK
, "NOT enforcing module verification\n");
8140 if (params
->feature_config_flags
&
8141 FEATURE_CONFIG_BC_SUPPORTS_DUAL_PHY_OPT_MDL_VRFY
) {
8142 /* Use specific phy request */
8143 cmd
= DRV_MSG_CODE_VRFY_SPECIFIC_PHY_OPT_MDL
;
8144 } else if (params
->feature_config_flags
&
8145 FEATURE_CONFIG_BC_SUPPORTS_OPT_MDL_VRFY
) {
8146 /* Use first phy request only in case of non-dual media*/
8147 if (DUAL_MEDIA(params
)) {
8149 "FW does not support OPT MDL verification\n");
8152 cmd
= DRV_MSG_CODE_VRFY_FIRST_PHY_OPT_MDL
;
8154 /* No support in OPT MDL detection */
8156 "FW does not support OPT MDL verification\n");
8160 fw_cmd_param
= FW_PARAM_SET(phy
->addr
, phy
->type
, phy
->mdio_ctrl
);
8161 fw_resp
= bnx2x_fw_command(bp
, cmd
, fw_cmd_param
);
8162 if (fw_resp
== FW_MSG_CODE_VRFY_OPT_MDL_SUCCESS
) {
8163 DP(NETIF_MSG_LINK
, "Approved module\n");
8167 /* Format the warning message */
8168 if (bnx2x_read_sfp_module_eeprom(phy
,
8170 SFP_EEPROM_VENDOR_NAME_ADDR
,
8171 SFP_EEPROM_VENDOR_NAME_SIZE
,
8173 vendor_name
[0] = '\0';
8175 vendor_name
[SFP_EEPROM_VENDOR_NAME_SIZE
] = '\0';
8176 if (bnx2x_read_sfp_module_eeprom(phy
,
8178 SFP_EEPROM_PART_NO_ADDR
,
8179 SFP_EEPROM_PART_NO_SIZE
,
8181 vendor_pn
[0] = '\0';
8183 vendor_pn
[SFP_EEPROM_PART_NO_SIZE
] = '\0';
8185 netdev_err(bp
->dev
, "Warning: Unqualified SFP+ module detected,"
8186 " Port %d from %s part number %s\n",
8187 params
->port
, vendor_name
, vendor_pn
);
8188 if ((val
& PORT_FEAT_CFG_OPT_MDL_ENFRCMNT_MASK
) !=
8189 PORT_FEAT_CFG_OPT_MDL_ENFRCMNT_WARNING_MSG
)
8190 phy
->flags
|= FLAGS_SFP_NOT_APPROVED
;
8194 static int bnx2x_wait_for_sfp_module_initialized(struct bnx2x_phy
*phy
,
8195 struct link_params
*params
)
8200 struct bnx2x
*bp
= params
->bp
;
8202 /* Initialization time after hot-plug may take up to 300ms for
8203 * some phys type ( e.g. JDSU )
8206 for (timeout
= 0; timeout
< 60; timeout
++) {
8207 if (phy
->type
== PORT_HW_CFG_XGXS_EXT_PHY_TYPE_DIRECT
)
8208 rc
= bnx2x_warpcore_read_sfp_module_eeprom(phy
,
8212 rc
= bnx2x_read_sfp_module_eeprom(phy
, params
, 1, 1,
8216 "SFP+ module initialization took %d ms\n",
8220 usleep_range(5000, 10000);
8222 rc
= bnx2x_read_sfp_module_eeprom(phy
, params
, 1, 1, &val
);
8226 static void bnx2x_8727_power_module(struct bnx2x
*bp
,
8227 struct bnx2x_phy
*phy
,
8229 /* Make sure GPIOs are not using for LED mode */
8231 /* In the GPIO register, bit 4 is use to determine if the GPIOs are
8232 * operating as INPUT or as OUTPUT. Bit 1 is for input, and 0 for
8234 * Bits 0-1 determine the GPIOs value for OUTPUT in case bit 4 val is 0
8235 * Bits 8-9 determine the GPIOs value for INPUT in case bit 4 val is 1
8236 * where the 1st bit is the over-current(only input), and 2nd bit is
8237 * for power( only output )
8239 * In case of NOC feature is disabled and power is up, set GPIO control
8240 * as input to enable listening of over-current indication
8242 if (phy
->flags
& FLAGS_NOC
)
8247 /* Set GPIO control to OUTPUT, and set the power bit
8248 * to according to the is_power_up
8252 bnx2x_cl45_write(bp
, phy
,
8254 MDIO_PMA_REG_8727_GPIO_CTRL
,
8258 static int bnx2x_8726_set_limiting_mode(struct bnx2x
*bp
,
8259 struct bnx2x_phy
*phy
,
8262 u16 cur_limiting_mode
;
8264 bnx2x_cl45_read(bp
, phy
,
8266 MDIO_PMA_REG_ROM_VER2
,
8267 &cur_limiting_mode
);
8268 DP(NETIF_MSG_LINK
, "Current Limiting mode is 0x%x\n",
8271 if (edc_mode
== EDC_MODE_LIMITING
) {
8272 DP(NETIF_MSG_LINK
, "Setting LIMITING MODE\n");
8273 bnx2x_cl45_write(bp
, phy
,
8275 MDIO_PMA_REG_ROM_VER2
,
8277 } else { /* LRM mode ( default )*/
8279 DP(NETIF_MSG_LINK
, "Setting LRM MODE\n");
8281 /* Changing to LRM mode takes quite few seconds. So do it only
8282 * if current mode is limiting (default is LRM)
8284 if (cur_limiting_mode
!= EDC_MODE_LIMITING
)
8287 bnx2x_cl45_write(bp
, phy
,
8289 MDIO_PMA_REG_LRM_MODE
,
8291 bnx2x_cl45_write(bp
, phy
,
8293 MDIO_PMA_REG_ROM_VER2
,
8295 bnx2x_cl45_write(bp
, phy
,
8297 MDIO_PMA_REG_MISC_CTRL0
,
8299 bnx2x_cl45_write(bp
, phy
,
8301 MDIO_PMA_REG_LRM_MODE
,
8307 static int bnx2x_8727_set_limiting_mode(struct bnx2x
*bp
,
8308 struct bnx2x_phy
*phy
,
8313 bnx2x_cl45_read(bp
, phy
,
8315 MDIO_PMA_REG_PHY_IDENTIFIER
,
8318 bnx2x_cl45_write(bp
, phy
,
8320 MDIO_PMA_REG_PHY_IDENTIFIER
,
8321 (phy_identifier
& ~(1<<9)));
8323 bnx2x_cl45_read(bp
, phy
,
8325 MDIO_PMA_REG_ROM_VER2
,
8327 /* Keep the MSB 8-bits, and set the LSB 8-bits with the edc_mode */
8328 bnx2x_cl45_write(bp
, phy
,
8330 MDIO_PMA_REG_ROM_VER2
,
8331 (rom_ver2_val
& 0xff00) | (edc_mode
& 0x00ff));
8333 bnx2x_cl45_write(bp
, phy
,
8335 MDIO_PMA_REG_PHY_IDENTIFIER
,
8336 (phy_identifier
| (1<<9)));
8341 static void bnx2x_8727_specific_func(struct bnx2x_phy
*phy
,
8342 struct link_params
*params
,
8345 struct bnx2x
*bp
= params
->bp
;
8349 bnx2x_sfp_set_transmitter(params
, phy
, 0);
8352 if (!(phy
->flags
& FLAGS_SFP_NOT_APPROVED
))
8353 bnx2x_sfp_set_transmitter(params
, phy
, 1);
8356 bnx2x_cl45_write(bp
, phy
,
8357 MDIO_PMA_DEVAD
, MDIO_PMA_LASI_RXCTRL
,
8359 bnx2x_cl45_write(bp
, phy
,
8360 MDIO_PMA_DEVAD
, MDIO_PMA_LASI_TXCTRL
,
8362 bnx2x_cl45_write(bp
, phy
,
8363 MDIO_PMA_DEVAD
, MDIO_PMA_LASI_CTRL
, 0x0006);
8364 /* Make MOD_ABS give interrupt on change */
8365 bnx2x_cl45_read(bp
, phy
, MDIO_PMA_DEVAD
,
8366 MDIO_PMA_REG_8727_PCS_OPT_CTRL
,
8369 if (phy
->flags
& FLAGS_NOC
)
8371 /* Set 8727 GPIOs to input to allow reading from the 8727 GPIO0
8372 * status which reflect SFP+ module over-current
8374 if (!(phy
->flags
& FLAGS_NOC
))
8375 val
&= 0xff8f; /* Reset bits 4-6 */
8376 bnx2x_cl45_write(bp
, phy
,
8377 MDIO_PMA_DEVAD
, MDIO_PMA_REG_8727_PCS_OPT_CTRL
,
8380 /* Set 2-wire transfer rate of SFP+ module EEPROM
8381 * to 100Khz since some DACs(direct attached cables) do
8382 * not work at 400Khz.
8384 bnx2x_cl45_write(bp
, phy
,
8386 MDIO_PMA_REG_8727_TWO_WIRE_SLAVE_ADDR
,
8390 DP(NETIF_MSG_LINK
, "Function 0x%x not supported by 8727\n",
8396 static void bnx2x_set_e1e2_module_fault_led(struct link_params
*params
,
8399 struct bnx2x
*bp
= params
->bp
;
8401 u32 fault_led_gpio
= REG_RD(bp
, params
->shmem_base
+
8402 offsetof(struct shmem_region
,
8403 dev_info
.port_hw_config
[params
->port
].sfp_ctrl
)) &
8404 PORT_HW_CFG_FAULT_MODULE_LED_MASK
;
8405 switch (fault_led_gpio
) {
8406 case PORT_HW_CFG_FAULT_MODULE_LED_DISABLED
:
8408 case PORT_HW_CFG_FAULT_MODULE_LED_GPIO0
:
8409 case PORT_HW_CFG_FAULT_MODULE_LED_GPIO1
:
8410 case PORT_HW_CFG_FAULT_MODULE_LED_GPIO2
:
8411 case PORT_HW_CFG_FAULT_MODULE_LED_GPIO3
:
8413 u8 gpio_port
= bnx2x_get_gpio_port(params
);
8414 u16 gpio_pin
= fault_led_gpio
-
8415 PORT_HW_CFG_FAULT_MODULE_LED_GPIO0
;
8416 DP(NETIF_MSG_LINK
, "Set fault module-detected led "
8417 "pin %x port %x mode %x\n",
8418 gpio_pin
, gpio_port
, gpio_mode
);
8419 bnx2x_set_gpio(bp
, gpio_pin
, gpio_mode
, gpio_port
);
8423 DP(NETIF_MSG_LINK
, "Error: Invalid fault led mode 0x%x\n",
8428 static void bnx2x_set_e3_module_fault_led(struct link_params
*params
,
8432 u8 port
= params
->port
;
8433 struct bnx2x
*bp
= params
->bp
;
8434 pin_cfg
= (REG_RD(bp
, params
->shmem_base
+
8435 offsetof(struct shmem_region
,
8436 dev_info
.port_hw_config
[port
].e3_sfp_ctrl
)) &
8437 PORT_HW_CFG_E3_FAULT_MDL_LED_MASK
) >>
8438 PORT_HW_CFG_E3_FAULT_MDL_LED_SHIFT
;
8439 DP(NETIF_MSG_LINK
, "Setting Fault LED to %d using pin cfg %d\n",
8440 gpio_mode
, pin_cfg
);
8441 bnx2x_set_cfg_pin(bp
, pin_cfg
, gpio_mode
);
8444 static void bnx2x_set_sfp_module_fault_led(struct link_params
*params
,
8447 struct bnx2x
*bp
= params
->bp
;
8448 DP(NETIF_MSG_LINK
, "Setting SFP+ module fault LED to %d\n", gpio_mode
);
8449 if (CHIP_IS_E3(bp
)) {
8450 /* Low ==> if SFP+ module is supported otherwise
8451 * High ==> if SFP+ module is not on the approved vendor list
8453 bnx2x_set_e3_module_fault_led(params
, gpio_mode
);
8455 bnx2x_set_e1e2_module_fault_led(params
, gpio_mode
);
8458 static void bnx2x_warpcore_hw_reset(struct bnx2x_phy
*phy
,
8459 struct link_params
*params
)
8461 struct bnx2x
*bp
= params
->bp
;
8462 bnx2x_warpcore_power_module(params
, 0);
8463 /* Put Warpcore in low power mode */
8464 REG_WR(bp
, MISC_REG_WC0_RESET
, 0x0c0e);
8466 /* Put LCPLL in low power mode */
8467 REG_WR(bp
, MISC_REG_LCPLL_E40_PWRDWN
, 1);
8468 REG_WR(bp
, MISC_REG_LCPLL_E40_RESETB_ANA
, 0);
8469 REG_WR(bp
, MISC_REG_LCPLL_E40_RESETB_DIG
, 0);
8472 static void bnx2x_power_sfp_module(struct link_params
*params
,
8473 struct bnx2x_phy
*phy
,
8476 struct bnx2x
*bp
= params
->bp
;
8477 DP(NETIF_MSG_LINK
, "Setting SFP+ power to %x\n", power
);
8479 switch (phy
->type
) {
8480 case PORT_HW_CFG_XGXS_EXT_PHY_TYPE_BCM8727
:
8481 case PORT_HW_CFG_XGXS_EXT_PHY_TYPE_BCM8722
:
8482 bnx2x_8727_power_module(params
->bp
, phy
, power
);
8484 case PORT_HW_CFG_XGXS_EXT_PHY_TYPE_DIRECT
:
8485 bnx2x_warpcore_power_module(params
, power
);
8491 static void bnx2x_warpcore_set_limiting_mode(struct link_params
*params
,
8492 struct bnx2x_phy
*phy
,
8496 u16 mode
= MDIO_WC_REG_UC_INFO_B1_FIRMWARE_MODE_DEFAULT
;
8497 struct bnx2x
*bp
= params
->bp
;
8499 u8 lane
= bnx2x_get_warpcore_lane(phy
, params
);
8500 /* This is a global register which controls all lanes */
8501 bnx2x_cl45_read(bp
, phy
, MDIO_WC_DEVAD
,
8502 MDIO_WC_REG_UC_INFO_B1_FIRMWARE_MODE
, &val
);
8503 val
&= ~(0xf << (lane
<< 2));
8506 case EDC_MODE_LINEAR
:
8507 case EDC_MODE_LIMITING
:
8508 mode
= MDIO_WC_REG_UC_INFO_B1_FIRMWARE_MODE_DEFAULT
;
8510 case EDC_MODE_PASSIVE_DAC
:
8511 mode
= MDIO_WC_REG_UC_INFO_B1_FIRMWARE_MODE_SFP_DAC
;
8517 val
|= (mode
<< (lane
<< 2));
8518 bnx2x_cl45_write(bp
, phy
, MDIO_WC_DEVAD
,
8519 MDIO_WC_REG_UC_INFO_B1_FIRMWARE_MODE
, val
);
8521 bnx2x_cl45_read(bp
, phy
, MDIO_WC_DEVAD
,
8522 MDIO_WC_REG_UC_INFO_B1_FIRMWARE_MODE
, &val
);
8524 /* Restart microcode to re-read the new mode */
8525 bnx2x_warpcore_reset_lane(bp
, phy
, 1);
8526 bnx2x_warpcore_reset_lane(bp
, phy
, 0);
8530 static void bnx2x_set_limiting_mode(struct link_params
*params
,
8531 struct bnx2x_phy
*phy
,
8534 switch (phy
->type
) {
8535 case PORT_HW_CFG_XGXS_EXT_PHY_TYPE_BCM8726
:
8536 bnx2x_8726_set_limiting_mode(params
->bp
, phy
, edc_mode
);
8538 case PORT_HW_CFG_XGXS_EXT_PHY_TYPE_BCM8727
:
8539 case PORT_HW_CFG_XGXS_EXT_PHY_TYPE_BCM8722
:
8540 bnx2x_8727_set_limiting_mode(params
->bp
, phy
, edc_mode
);
8542 case PORT_HW_CFG_XGXS_EXT_PHY_TYPE_DIRECT
:
8543 bnx2x_warpcore_set_limiting_mode(params
, phy
, edc_mode
);
8548 int bnx2x_sfp_module_detection(struct bnx2x_phy
*phy
,
8549 struct link_params
*params
)
8551 struct bnx2x
*bp
= params
->bp
;
8555 u32 val
= REG_RD(bp
, params
->shmem_base
+
8556 offsetof(struct shmem_region
, dev_info
.
8557 port_feature_config
[params
->port
].config
));
8558 /* Enabled transmitter by default */
8559 bnx2x_sfp_set_transmitter(params
, phy
, 1);
8560 DP(NETIF_MSG_LINK
, "SFP+ module plugged in/out detected on port %d\n",
8562 /* Power up module */
8563 bnx2x_power_sfp_module(params
, phy
, 1);
8564 if (bnx2x_get_edc_mode(phy
, params
, &edc_mode
) != 0) {
8565 DP(NETIF_MSG_LINK
, "Failed to get valid module type\n");
8567 } else if (bnx2x_verify_sfp_module(phy
, params
) != 0) {
8568 /* Check SFP+ module compatibility */
8569 DP(NETIF_MSG_LINK
, "Module verification failed!!\n");
8571 /* Turn on fault module-detected led */
8572 bnx2x_set_sfp_module_fault_led(params
,
8573 MISC_REGISTERS_GPIO_HIGH
);
8575 /* Check if need to power down the SFP+ module */
8576 if ((val
& PORT_FEAT_CFG_OPT_MDL_ENFRCMNT_MASK
) ==
8577 PORT_FEAT_CFG_OPT_MDL_ENFRCMNT_POWER_DOWN
) {
8578 DP(NETIF_MSG_LINK
, "Shutdown SFP+ module!!\n");
8579 bnx2x_power_sfp_module(params
, phy
, 0);
8583 /* Turn off fault module-detected led */
8584 bnx2x_set_sfp_module_fault_led(params
, MISC_REGISTERS_GPIO_LOW
);
8587 /* Check and set limiting mode / LRM mode on 8726. On 8727 it
8588 * is done automatically
8590 bnx2x_set_limiting_mode(params
, phy
, edc_mode
);
8592 /* Disable transmit for this module if the module is not approved, and
8593 * laser needs to be disabled.
8596 ((val
& PORT_FEAT_CFG_OPT_MDL_ENFRCMNT_MASK
) ==
8597 PORT_FEAT_CFG_OPT_MDL_ENFRCMNT_DISABLE_TX_LASER
))
8598 bnx2x_sfp_set_transmitter(params
, phy
, 0);
8603 void bnx2x_handle_module_detect_int(struct link_params
*params
)
8605 struct bnx2x
*bp
= params
->bp
;
8606 struct bnx2x_phy
*phy
;
8608 u8 gpio_num
, gpio_port
;
8609 if (CHIP_IS_E3(bp
)) {
8610 phy
= ¶ms
->phy
[INT_PHY
];
8611 /* Always enable TX laser,will be disabled in case of fault */
8612 bnx2x_sfp_set_transmitter(params
, phy
, 1);
8614 phy
= ¶ms
->phy
[EXT_PHY1
];
8616 if (bnx2x_get_mod_abs_int_cfg(bp
, params
->chip_id
, params
->shmem_base
,
8617 params
->port
, &gpio_num
, &gpio_port
) ==
8619 DP(NETIF_MSG_LINK
, "Failed to get MOD_ABS interrupt config\n");
8623 /* Set valid module led off */
8624 bnx2x_set_sfp_module_fault_led(params
, MISC_REGISTERS_GPIO_HIGH
);
8626 /* Get current gpio val reflecting module plugged in / out*/
8627 gpio_val
= bnx2x_get_gpio(bp
, gpio_num
, gpio_port
);
8629 /* Call the handling function in case module is detected */
8630 if (gpio_val
== 0) {
8631 bnx2x_set_mdio_emac_per_phy(bp
, params
);
8632 bnx2x_set_aer_mmd(params
, phy
);
8634 bnx2x_power_sfp_module(params
, phy
, 1);
8635 bnx2x_set_gpio_int(bp
, gpio_num
,
8636 MISC_REGISTERS_GPIO_INT_OUTPUT_CLR
,
8638 if (bnx2x_wait_for_sfp_module_initialized(phy
, params
) == 0) {
8639 bnx2x_sfp_module_detection(phy
, params
);
8640 if (CHIP_IS_E3(bp
)) {
8642 /* In case WC is out of reset, reconfigure the
8643 * link speed while taking into account 1G
8644 * module limitation.
8646 bnx2x_cl45_read(bp
, phy
,
8648 MDIO_WC_REG_DIGITAL5_MISC6
,
8650 if ((!rx_tx_in_reset
) &&
8651 (params
->link_flags
&
8653 bnx2x_warpcore_reset_lane(bp
, phy
, 1);
8654 bnx2x_warpcore_config_sfi(phy
, params
);
8655 bnx2x_warpcore_reset_lane(bp
, phy
, 0);
8659 DP(NETIF_MSG_LINK
, "SFP+ module is not initialized\n");
8662 bnx2x_set_gpio_int(bp
, gpio_num
,
8663 MISC_REGISTERS_GPIO_INT_OUTPUT_SET
,
8665 /* Module was plugged out.
8666 * Disable transmit for this module
8668 phy
->media_type
= ETH_PHY_NOT_PRESENT
;
8672 /******************************************************************/
8673 /* Used by 8706 and 8727 */
8674 /******************************************************************/
8675 static void bnx2x_sfp_mask_fault(struct bnx2x
*bp
,
8676 struct bnx2x_phy
*phy
,
8677 u16 alarm_status_offset
,
8678 u16 alarm_ctrl_offset
)
8680 u16 alarm_status
, val
;
8681 bnx2x_cl45_read(bp
, phy
,
8682 MDIO_PMA_DEVAD
, alarm_status_offset
,
8684 bnx2x_cl45_read(bp
, phy
,
8685 MDIO_PMA_DEVAD
, alarm_status_offset
,
8687 /* Mask or enable the fault event. */
8688 bnx2x_cl45_read(bp
, phy
, MDIO_PMA_DEVAD
, alarm_ctrl_offset
, &val
);
8689 if (alarm_status
& (1<<0))
8693 bnx2x_cl45_write(bp
, phy
, MDIO_PMA_DEVAD
, alarm_ctrl_offset
, val
);
8695 /******************************************************************/
8696 /* common BCM8706/BCM8726 PHY SECTION */
8697 /******************************************************************/
8698 static u8
bnx2x_8706_8726_read_status(struct bnx2x_phy
*phy
,
8699 struct link_params
*params
,
8700 struct link_vars
*vars
)
8703 u16 val1
, val2
, rx_sd
, pcs_status
;
8704 struct bnx2x
*bp
= params
->bp
;
8705 DP(NETIF_MSG_LINK
, "XGXS 8706/8726\n");
8707 bnx2x_cl45_read(bp
, phy
,
8708 MDIO_PMA_DEVAD
, MDIO_PMA_LASI_RXSTAT
, &val2
);
8710 bnx2x_sfp_mask_fault(bp
, phy
, MDIO_PMA_LASI_TXSTAT
,
8711 MDIO_PMA_LASI_TXCTRL
);
8713 /* Clear LASI indication*/
8714 bnx2x_cl45_read(bp
, phy
,
8715 MDIO_PMA_DEVAD
, MDIO_PMA_LASI_STAT
, &val1
);
8716 bnx2x_cl45_read(bp
, phy
,
8717 MDIO_PMA_DEVAD
, MDIO_PMA_LASI_STAT
, &val2
);
8718 DP(NETIF_MSG_LINK
, "8706/8726 LASI status 0x%x--> 0x%x\n", val1
, val2
);
8720 bnx2x_cl45_read(bp
, phy
,
8721 MDIO_PMA_DEVAD
, MDIO_PMA_REG_RX_SD
, &rx_sd
);
8722 bnx2x_cl45_read(bp
, phy
,
8723 MDIO_PCS_DEVAD
, MDIO_PCS_REG_STATUS
, &pcs_status
);
8724 bnx2x_cl45_read(bp
, phy
,
8725 MDIO_AN_DEVAD
, MDIO_AN_REG_LINK_STATUS
, &val2
);
8726 bnx2x_cl45_read(bp
, phy
,
8727 MDIO_AN_DEVAD
, MDIO_AN_REG_LINK_STATUS
, &val2
);
8729 DP(NETIF_MSG_LINK
, "8706/8726 rx_sd 0x%x pcs_status 0x%x 1Gbps"
8730 " link_status 0x%x\n", rx_sd
, pcs_status
, val2
);
8731 /* Link is up if both bit 0 of pmd_rx_sd and bit 0 of pcs_status
8732 * are set, or if the autoneg bit 1 is set
8734 link_up
= ((rx_sd
& pcs_status
& 0x1) || (val2
& (1<<1)));
8737 vars
->line_speed
= SPEED_1000
;
8739 vars
->line_speed
= SPEED_10000
;
8740 bnx2x_ext_phy_resolve_fc(phy
, params
, vars
);
8741 vars
->duplex
= DUPLEX_FULL
;
8744 /* Capture 10G link fault. Read twice to clear stale value. */
8745 if (vars
->line_speed
== SPEED_10000
) {
8746 bnx2x_cl45_read(bp
, phy
, MDIO_PMA_DEVAD
,
8747 MDIO_PMA_LASI_TXSTAT
, &val1
);
8748 bnx2x_cl45_read(bp
, phy
, MDIO_PMA_DEVAD
,
8749 MDIO_PMA_LASI_TXSTAT
, &val1
);
8751 vars
->fault_detected
= 1;
8757 /******************************************************************/
8758 /* BCM8706 PHY SECTION */
8759 /******************************************************************/
8760 static u8
bnx2x_8706_config_init(struct bnx2x_phy
*phy
,
8761 struct link_params
*params
,
8762 struct link_vars
*vars
)
8766 struct bnx2x
*bp
= params
->bp
;
8768 bnx2x_set_gpio(bp
, MISC_REGISTERS_GPIO_2
,
8769 MISC_REGISTERS_GPIO_OUTPUT_HIGH
, params
->port
);
8771 bnx2x_ext_phy_hw_reset(bp
, params
->port
);
8772 bnx2x_cl45_write(bp
, phy
, MDIO_PMA_DEVAD
, MDIO_PMA_REG_CTRL
, 0xa040);
8773 bnx2x_wait_reset_complete(bp
, phy
, params
);
8775 /* Wait until fw is loaded */
8776 for (cnt
= 0; cnt
< 100; cnt
++) {
8777 bnx2x_cl45_read(bp
, phy
,
8778 MDIO_PMA_DEVAD
, MDIO_PMA_REG_ROM_VER1
, &val
);
8781 usleep_range(10000, 20000);
8783 DP(NETIF_MSG_LINK
, "XGXS 8706 is initialized after %d ms\n", cnt
);
8784 if ((params
->feature_config_flags
&
8785 FEATURE_CONFIG_OVERRIDE_PREEMPHASIS_ENABLED
)) {
8788 for (i
= 0; i
< 4; i
++) {
8789 reg
= MDIO_XS_8706_REG_BANK_RX0
+
8790 i
*(MDIO_XS_8706_REG_BANK_RX1
-
8791 MDIO_XS_8706_REG_BANK_RX0
);
8792 bnx2x_cl45_read(bp
, phy
, MDIO_XS_DEVAD
, reg
, &val
);
8793 /* Clear first 3 bits of the control */
8795 /* Set control bits according to configuration */
8796 val
|= (phy
->rx_preemphasis
[i
] & 0x7);
8797 DP(NETIF_MSG_LINK
, "Setting RX Equalizer to BCM8706"
8798 " reg 0x%x <-- val 0x%x\n", reg
, val
);
8799 bnx2x_cl45_write(bp
, phy
, MDIO_XS_DEVAD
, reg
, val
);
8803 if (phy
->req_line_speed
== SPEED_10000
) {
8804 DP(NETIF_MSG_LINK
, "XGXS 8706 force 10Gbps\n");
8806 bnx2x_cl45_write(bp
, phy
,
8808 MDIO_PMA_REG_DIGITAL_CTRL
, 0x400);
8809 bnx2x_cl45_write(bp
, phy
,
8810 MDIO_PMA_DEVAD
, MDIO_PMA_LASI_TXCTRL
,
8812 /* Arm LASI for link and Tx fault. */
8813 bnx2x_cl45_write(bp
, phy
,
8814 MDIO_PMA_DEVAD
, MDIO_PMA_LASI_CTRL
, 3);
8816 /* Force 1Gbps using autoneg with 1G advertisement */
8818 /* Allow CL37 through CL73 */
8819 DP(NETIF_MSG_LINK
, "XGXS 8706 AutoNeg\n");
8820 bnx2x_cl45_write(bp
, phy
,
8821 MDIO_AN_DEVAD
, MDIO_AN_REG_CL37_CL73
, 0x040c);
8823 /* Enable Full-Duplex advertisement on CL37 */
8824 bnx2x_cl45_write(bp
, phy
,
8825 MDIO_AN_DEVAD
, MDIO_AN_REG_CL37_FC_LP
, 0x0020);
8826 /* Enable CL37 AN */
8827 bnx2x_cl45_write(bp
, phy
,
8828 MDIO_AN_DEVAD
, MDIO_AN_REG_CL37_AN
, 0x1000);
8830 bnx2x_cl45_write(bp
, phy
,
8831 MDIO_AN_DEVAD
, MDIO_AN_REG_ADV
, (1<<5));
8833 /* Enable clause 73 AN */
8834 bnx2x_cl45_write(bp
, phy
,
8835 MDIO_AN_DEVAD
, MDIO_AN_REG_CTRL
, 0x1200);
8836 bnx2x_cl45_write(bp
, phy
,
8837 MDIO_PMA_DEVAD
, MDIO_PMA_LASI_RXCTRL
,
8839 bnx2x_cl45_write(bp
, phy
,
8840 MDIO_PMA_DEVAD
, MDIO_PMA_LASI_CTRL
,
8843 bnx2x_save_bcm_spirom_ver(bp
, phy
, params
->port
);
8845 /* If TX Laser is controlled by GPIO_0, do not let PHY go into low
8846 * power mode, if TX Laser is disabled
8849 tx_en_mode
= REG_RD(bp
, params
->shmem_base
+
8850 offsetof(struct shmem_region
,
8851 dev_info
.port_hw_config
[params
->port
].sfp_ctrl
))
8852 & PORT_HW_CFG_TX_LASER_MASK
;
8854 if (tx_en_mode
== PORT_HW_CFG_TX_LASER_GPIO0
) {
8855 DP(NETIF_MSG_LINK
, "Enabling TXONOFF_PWRDN_DIS\n");
8856 bnx2x_cl45_read(bp
, phy
,
8857 MDIO_PMA_DEVAD
, MDIO_PMA_REG_DIGITAL_CTRL
, &tmp1
);
8859 bnx2x_cl45_write(bp
, phy
,
8860 MDIO_PMA_DEVAD
, MDIO_PMA_REG_DIGITAL_CTRL
, tmp1
);
8866 static int bnx2x_8706_read_status(struct bnx2x_phy
*phy
,
8867 struct link_params
*params
,
8868 struct link_vars
*vars
)
8870 return bnx2x_8706_8726_read_status(phy
, params
, vars
);
8873 /******************************************************************/
8874 /* BCM8726 PHY SECTION */
8875 /******************************************************************/
8876 static void bnx2x_8726_config_loopback(struct bnx2x_phy
*phy
,
8877 struct link_params
*params
)
8879 struct bnx2x
*bp
= params
->bp
;
8880 DP(NETIF_MSG_LINK
, "PMA/PMD ext_phy_loopback: 8726\n");
8881 bnx2x_cl45_write(bp
, phy
, MDIO_PMA_DEVAD
, MDIO_PMA_REG_CTRL
, 0x0001);
8884 static void bnx2x_8726_external_rom_boot(struct bnx2x_phy
*phy
,
8885 struct link_params
*params
)
8887 struct bnx2x
*bp
= params
->bp
;
8888 /* Need to wait 100ms after reset */
8891 /* Micro controller re-boot */
8892 bnx2x_cl45_write(bp
, phy
,
8893 MDIO_PMA_DEVAD
, MDIO_PMA_REG_GEN_CTRL
, 0x018B);
8895 /* Set soft reset */
8896 bnx2x_cl45_write(bp
, phy
,
8898 MDIO_PMA_REG_GEN_CTRL
,
8899 MDIO_PMA_REG_GEN_CTRL_ROM_MICRO_RESET
);
8901 bnx2x_cl45_write(bp
, phy
,
8903 MDIO_PMA_REG_MISC_CTRL1
, 0x0001);
8905 bnx2x_cl45_write(bp
, phy
,
8907 MDIO_PMA_REG_GEN_CTRL
,
8908 MDIO_PMA_REG_GEN_CTRL_ROM_RESET_INTERNAL_MP
);
8910 /* Wait for 150ms for microcode load */
8913 /* Disable serial boot control, tristates pins SS_N, SCK, MOSI, MISO */
8914 bnx2x_cl45_write(bp
, phy
,
8916 MDIO_PMA_REG_MISC_CTRL1
, 0x0000);
8919 bnx2x_save_bcm_spirom_ver(bp
, phy
, params
->port
);
8922 static u8
bnx2x_8726_read_status(struct bnx2x_phy
*phy
,
8923 struct link_params
*params
,
8924 struct link_vars
*vars
)
8926 struct bnx2x
*bp
= params
->bp
;
8928 u8 link_up
= bnx2x_8706_8726_read_status(phy
, params
, vars
);
8930 bnx2x_cl45_read(bp
, phy
,
8931 MDIO_PMA_DEVAD
, MDIO_PMA_REG_PHY_IDENTIFIER
,
8933 if (val1
& (1<<15)) {
8934 DP(NETIF_MSG_LINK
, "Tx is disabled\n");
8936 vars
->line_speed
= 0;
8943 static int bnx2x_8726_config_init(struct bnx2x_phy
*phy
,
8944 struct link_params
*params
,
8945 struct link_vars
*vars
)
8947 struct bnx2x
*bp
= params
->bp
;
8948 DP(NETIF_MSG_LINK
, "Initializing BCM8726\n");
8950 bnx2x_cl45_write(bp
, phy
, MDIO_PMA_DEVAD
, MDIO_PMA_REG_CTRL
, 1<<15);
8951 bnx2x_wait_reset_complete(bp
, phy
, params
);
8953 bnx2x_8726_external_rom_boot(phy
, params
);
8955 /* Need to call module detected on initialization since the module
8956 * detection triggered by actual module insertion might occur before
8957 * driver is loaded, and when driver is loaded, it reset all
8958 * registers, including the transmitter
8960 bnx2x_sfp_module_detection(phy
, params
);
8962 if (phy
->req_line_speed
== SPEED_1000
) {
8963 DP(NETIF_MSG_LINK
, "Setting 1G force\n");
8964 bnx2x_cl45_write(bp
, phy
,
8965 MDIO_PMA_DEVAD
, MDIO_PMA_REG_CTRL
, 0x40);
8966 bnx2x_cl45_write(bp
, phy
,
8967 MDIO_PMA_DEVAD
, MDIO_PMA_REG_10G_CTRL2
, 0xD);
8968 bnx2x_cl45_write(bp
, phy
,
8969 MDIO_PMA_DEVAD
, MDIO_PMA_LASI_CTRL
, 0x5);
8970 bnx2x_cl45_write(bp
, phy
,
8971 MDIO_PMA_DEVAD
, MDIO_PMA_LASI_RXCTRL
,
8973 } else if ((phy
->req_line_speed
== SPEED_AUTO_NEG
) &&
8974 (phy
->speed_cap_mask
&
8975 PORT_HW_CFG_SPEED_CAPABILITY_D0_1G
) &&
8976 ((phy
->speed_cap_mask
&
8977 PORT_HW_CFG_SPEED_CAPABILITY_D0_10G
) !=
8978 PORT_HW_CFG_SPEED_CAPABILITY_D0_10G
)) {
8979 DP(NETIF_MSG_LINK
, "Setting 1G clause37\n");
8980 /* Set Flow control */
8981 bnx2x_ext_phy_set_pause(params
, phy
, vars
);
8982 bnx2x_cl45_write(bp
, phy
,
8983 MDIO_AN_DEVAD
, MDIO_AN_REG_ADV
, 0x20);
8984 bnx2x_cl45_write(bp
, phy
,
8985 MDIO_AN_DEVAD
, MDIO_AN_REG_CL37_CL73
, 0x040c);
8986 bnx2x_cl45_write(bp
, phy
,
8987 MDIO_AN_DEVAD
, MDIO_AN_REG_CL37_FC_LD
, 0x0020);
8988 bnx2x_cl45_write(bp
, phy
,
8989 MDIO_AN_DEVAD
, MDIO_AN_REG_CL37_AN
, 0x1000);
8990 bnx2x_cl45_write(bp
, phy
,
8991 MDIO_AN_DEVAD
, MDIO_AN_REG_CTRL
, 0x1200);
8992 /* Enable RX-ALARM control to receive interrupt for 1G speed
8995 bnx2x_cl45_write(bp
, phy
,
8996 MDIO_PMA_DEVAD
, MDIO_PMA_LASI_CTRL
, 0x4);
8997 bnx2x_cl45_write(bp
, phy
,
8998 MDIO_PMA_DEVAD
, MDIO_PMA_LASI_RXCTRL
,
9001 } else { /* Default 10G. Set only LASI control */
9002 bnx2x_cl45_write(bp
, phy
,
9003 MDIO_PMA_DEVAD
, MDIO_PMA_LASI_CTRL
, 1);
9006 /* Set TX PreEmphasis if needed */
9007 if ((params
->feature_config_flags
&
9008 FEATURE_CONFIG_OVERRIDE_PREEMPHASIS_ENABLED
)) {
9010 "Setting TX_CTRL1 0x%x, TX_CTRL2 0x%x\n",
9011 phy
->tx_preemphasis
[0],
9012 phy
->tx_preemphasis
[1]);
9013 bnx2x_cl45_write(bp
, phy
,
9015 MDIO_PMA_REG_8726_TX_CTRL1
,
9016 phy
->tx_preemphasis
[0]);
9018 bnx2x_cl45_write(bp
, phy
,
9020 MDIO_PMA_REG_8726_TX_CTRL2
,
9021 phy
->tx_preemphasis
[1]);
9028 static void bnx2x_8726_link_reset(struct bnx2x_phy
*phy
,
9029 struct link_params
*params
)
9031 struct bnx2x
*bp
= params
->bp
;
9032 DP(NETIF_MSG_LINK
, "bnx2x_8726_link_reset port %d\n", params
->port
);
9033 /* Set serial boot control for external load */
9034 bnx2x_cl45_write(bp
, phy
,
9036 MDIO_PMA_REG_GEN_CTRL
, 0x0001);
9039 /******************************************************************/
9040 /* BCM8727 PHY SECTION */
9041 /******************************************************************/
9043 static void bnx2x_8727_set_link_led(struct bnx2x_phy
*phy
,
9044 struct link_params
*params
, u8 mode
)
9046 struct bnx2x
*bp
= params
->bp
;
9047 u16 led_mode_bitmask
= 0;
9048 u16 gpio_pins_bitmask
= 0;
9050 /* Only NOC flavor requires to set the LED specifically */
9051 if (!(phy
->flags
& FLAGS_NOC
))
9054 case LED_MODE_FRONT_PANEL_OFF
:
9056 led_mode_bitmask
= 0;
9057 gpio_pins_bitmask
= 0x03;
9060 led_mode_bitmask
= 0;
9061 gpio_pins_bitmask
= 0x02;
9064 led_mode_bitmask
= 0x60;
9065 gpio_pins_bitmask
= 0x11;
9068 bnx2x_cl45_read(bp
, phy
,
9070 MDIO_PMA_REG_8727_PCS_OPT_CTRL
,
9073 val
|= led_mode_bitmask
;
9074 bnx2x_cl45_write(bp
, phy
,
9076 MDIO_PMA_REG_8727_PCS_OPT_CTRL
,
9078 bnx2x_cl45_read(bp
, phy
,
9080 MDIO_PMA_REG_8727_GPIO_CTRL
,
9083 val
|= gpio_pins_bitmask
;
9084 bnx2x_cl45_write(bp
, phy
,
9086 MDIO_PMA_REG_8727_GPIO_CTRL
,
9089 static void bnx2x_8727_hw_reset(struct bnx2x_phy
*phy
,
9090 struct link_params
*params
) {
9091 u32 swap_val
, swap_override
;
9093 /* The PHY reset is controlled by GPIO 1. Fake the port number
9094 * to cancel the swap done in set_gpio()
9096 struct bnx2x
*bp
= params
->bp
;
9097 swap_val
= REG_RD(bp
, NIG_REG_PORT_SWAP
);
9098 swap_override
= REG_RD(bp
, NIG_REG_STRAP_OVERRIDE
);
9099 port
= (swap_val
&& swap_override
) ^ 1;
9100 bnx2x_set_gpio(bp
, MISC_REGISTERS_GPIO_1
,
9101 MISC_REGISTERS_GPIO_OUTPUT_LOW
, port
);
9104 static void bnx2x_8727_config_speed(struct bnx2x_phy
*phy
,
9105 struct link_params
*params
)
9107 struct bnx2x
*bp
= params
->bp
;
9109 /* Set option 1G speed */
9110 if ((phy
->req_line_speed
== SPEED_1000
) ||
9111 (phy
->media_type
== ETH_PHY_SFP_1G_FIBER
)) {
9112 DP(NETIF_MSG_LINK
, "Setting 1G force\n");
9113 bnx2x_cl45_write(bp
, phy
,
9114 MDIO_PMA_DEVAD
, MDIO_PMA_REG_CTRL
, 0x40);
9115 bnx2x_cl45_write(bp
, phy
,
9116 MDIO_PMA_DEVAD
, MDIO_PMA_REG_10G_CTRL2
, 0xD);
9117 bnx2x_cl45_read(bp
, phy
,
9118 MDIO_PMA_DEVAD
, MDIO_PMA_REG_10G_CTRL2
, &tmp1
);
9119 DP(NETIF_MSG_LINK
, "1.7 = 0x%x\n", tmp1
);
9120 /* Power down the XAUI until link is up in case of dual-media
9123 if (DUAL_MEDIA(params
)) {
9124 bnx2x_cl45_read(bp
, phy
,
9126 MDIO_PMA_REG_8727_PCS_GP
, &val
);
9128 bnx2x_cl45_write(bp
, phy
,
9130 MDIO_PMA_REG_8727_PCS_GP
, val
);
9132 } else if ((phy
->req_line_speed
== SPEED_AUTO_NEG
) &&
9133 ((phy
->speed_cap_mask
&
9134 PORT_HW_CFG_SPEED_CAPABILITY_D0_1G
)) &&
9135 ((phy
->speed_cap_mask
&
9136 PORT_HW_CFG_SPEED_CAPABILITY_D0_10G
) !=
9137 PORT_HW_CFG_SPEED_CAPABILITY_D0_10G
)) {
9139 DP(NETIF_MSG_LINK
, "Setting 1G clause37\n");
9140 bnx2x_cl45_write(bp
, phy
,
9141 MDIO_AN_DEVAD
, MDIO_AN_REG_8727_MISC_CTRL
, 0);
9142 bnx2x_cl45_write(bp
, phy
,
9143 MDIO_AN_DEVAD
, MDIO_AN_REG_CL37_AN
, 0x1300);
9145 /* Since the 8727 has only single reset pin, need to set the 10G
9146 * registers although it is default
9148 bnx2x_cl45_write(bp
, phy
,
9149 MDIO_AN_DEVAD
, MDIO_AN_REG_8727_MISC_CTRL
,
9151 bnx2x_cl45_write(bp
, phy
,
9152 MDIO_AN_DEVAD
, MDIO_AN_REG_CL37_AN
, 0x0100);
9153 bnx2x_cl45_write(bp
, phy
,
9154 MDIO_PMA_DEVAD
, MDIO_PMA_REG_CTRL
, 0x2040);
9155 bnx2x_cl45_write(bp
, phy
,
9156 MDIO_PMA_DEVAD
, MDIO_PMA_REG_10G_CTRL2
,
9161 static int bnx2x_8727_config_init(struct bnx2x_phy
*phy
,
9162 struct link_params
*params
,
9163 struct link_vars
*vars
)
9166 u16 tmp1
, mod_abs
, tmp2
;
9167 struct bnx2x
*bp
= params
->bp
;
9168 /* Enable PMD link, MOD_ABS_FLT, and 1G link alarm */
9170 bnx2x_wait_reset_complete(bp
, phy
, params
);
9172 DP(NETIF_MSG_LINK
, "Initializing BCM8727\n");
9174 bnx2x_8727_specific_func(phy
, params
, PHY_INIT
);
9175 /* Initially configure MOD_ABS to interrupt when module is
9178 bnx2x_cl45_read(bp
, phy
,
9179 MDIO_PMA_DEVAD
, MDIO_PMA_REG_PHY_IDENTIFIER
, &mod_abs
);
9180 /* Set EDC off by setting OPTXLOS signal input to low (bit 9).
9181 * When the EDC is off it locks onto a reference clock and avoids
9185 if (!(phy
->flags
& FLAGS_NOC
))
9187 bnx2x_cl45_write(bp
, phy
,
9188 MDIO_PMA_DEVAD
, MDIO_PMA_REG_PHY_IDENTIFIER
, mod_abs
);
9190 /* Enable/Disable PHY transmitter output */
9191 bnx2x_set_disable_pmd_transmit(params
, phy
, 0);
9193 bnx2x_8727_power_module(bp
, phy
, 1);
9195 bnx2x_cl45_read(bp
, phy
,
9196 MDIO_PMA_DEVAD
, MDIO_PMA_REG_M8051_MSGOUT_REG
, &tmp1
);
9198 bnx2x_cl45_read(bp
, phy
,
9199 MDIO_PMA_DEVAD
, MDIO_PMA_LASI_RXSTAT
, &tmp1
);
9201 bnx2x_8727_config_speed(phy
, params
);
9204 /* Set TX PreEmphasis if needed */
9205 if ((params
->feature_config_flags
&
9206 FEATURE_CONFIG_OVERRIDE_PREEMPHASIS_ENABLED
)) {
9207 DP(NETIF_MSG_LINK
, "Setting TX_CTRL1 0x%x, TX_CTRL2 0x%x\n",
9208 phy
->tx_preemphasis
[0],
9209 phy
->tx_preemphasis
[1]);
9210 bnx2x_cl45_write(bp
, phy
,
9211 MDIO_PMA_DEVAD
, MDIO_PMA_REG_8727_TX_CTRL1
,
9212 phy
->tx_preemphasis
[0]);
9214 bnx2x_cl45_write(bp
, phy
,
9215 MDIO_PMA_DEVAD
, MDIO_PMA_REG_8727_TX_CTRL2
,
9216 phy
->tx_preemphasis
[1]);
9219 /* If TX Laser is controlled by GPIO_0, do not let PHY go into low
9220 * power mode, if TX Laser is disabled
9222 tx_en_mode
= REG_RD(bp
, params
->shmem_base
+
9223 offsetof(struct shmem_region
,
9224 dev_info
.port_hw_config
[params
->port
].sfp_ctrl
))
9225 & PORT_HW_CFG_TX_LASER_MASK
;
9227 if (tx_en_mode
== PORT_HW_CFG_TX_LASER_GPIO0
) {
9229 DP(NETIF_MSG_LINK
, "Enabling TXONOFF_PWRDN_DIS\n");
9230 bnx2x_cl45_read(bp
, phy
,
9231 MDIO_PMA_DEVAD
, MDIO_PMA_REG_8727_OPT_CFG_REG
, &tmp2
);
9234 bnx2x_cl45_write(bp
, phy
,
9235 MDIO_PMA_DEVAD
, MDIO_PMA_REG_8727_OPT_CFG_REG
, tmp2
);
9236 bnx2x_cl45_read(bp
, phy
,
9237 MDIO_PMA_DEVAD
, MDIO_PMA_REG_PHY_IDENTIFIER
,
9239 bnx2x_cl45_write(bp
, phy
,
9240 MDIO_PMA_DEVAD
, MDIO_PMA_REG_PHY_IDENTIFIER
,
9247 static void bnx2x_8727_handle_mod_abs(struct bnx2x_phy
*phy
,
9248 struct link_params
*params
)
9250 struct bnx2x
*bp
= params
->bp
;
9251 u16 mod_abs
, rx_alarm_status
;
9252 u32 val
= REG_RD(bp
, params
->shmem_base
+
9253 offsetof(struct shmem_region
, dev_info
.
9254 port_feature_config
[params
->port
].
9256 bnx2x_cl45_read(bp
, phy
,
9258 MDIO_PMA_REG_PHY_IDENTIFIER
, &mod_abs
);
9259 if (mod_abs
& (1<<8)) {
9261 /* Module is absent */
9263 "MOD_ABS indication show module is absent\n");
9264 phy
->media_type
= ETH_PHY_NOT_PRESENT
;
9265 /* 1. Set mod_abs to detect next module
9267 * 2. Set EDC off by setting OPTXLOS signal input to low
9269 * When the EDC is off it locks onto a reference clock and
9270 * avoids becoming 'lost'.
9273 if (!(phy
->flags
& FLAGS_NOC
))
9275 bnx2x_cl45_write(bp
, phy
,
9277 MDIO_PMA_REG_PHY_IDENTIFIER
, mod_abs
);
9279 /* Clear RX alarm since it stays up as long as
9280 * the mod_abs wasn't changed
9282 bnx2x_cl45_read(bp
, phy
,
9284 MDIO_PMA_LASI_RXSTAT
, &rx_alarm_status
);
9287 /* Module is present */
9289 "MOD_ABS indication show module is present\n");
9290 /* First disable transmitter, and if the module is ok, the
9291 * module_detection will enable it
9292 * 1. Set mod_abs to detect next module absent event ( bit 8)
9293 * 2. Restore the default polarity of the OPRXLOS signal and
9294 * this signal will then correctly indicate the presence or
9295 * absence of the Rx signal. (bit 9)
9298 if (!(phy
->flags
& FLAGS_NOC
))
9300 bnx2x_cl45_write(bp
, phy
,
9302 MDIO_PMA_REG_PHY_IDENTIFIER
, mod_abs
);
9304 /* Clear RX alarm since it stays up as long as the mod_abs
9305 * wasn't changed. This is need to be done before calling the
9306 * module detection, otherwise it will clear* the link update
9309 bnx2x_cl45_read(bp
, phy
,
9311 MDIO_PMA_LASI_RXSTAT
, &rx_alarm_status
);
9314 if ((val
& PORT_FEAT_CFG_OPT_MDL_ENFRCMNT_MASK
) ==
9315 PORT_FEAT_CFG_OPT_MDL_ENFRCMNT_DISABLE_TX_LASER
)
9316 bnx2x_sfp_set_transmitter(params
, phy
, 0);
9318 if (bnx2x_wait_for_sfp_module_initialized(phy
, params
) == 0)
9319 bnx2x_sfp_module_detection(phy
, params
);
9321 DP(NETIF_MSG_LINK
, "SFP+ module is not initialized\n");
9323 /* Reconfigure link speed based on module type limitations */
9324 bnx2x_8727_config_speed(phy
, params
);
9327 DP(NETIF_MSG_LINK
, "8727 RX_ALARM_STATUS 0x%x\n",
9329 /* No need to check link status in case of module plugged in/out */
9332 static u8
bnx2x_8727_read_status(struct bnx2x_phy
*phy
,
9333 struct link_params
*params
,
9334 struct link_vars
*vars
)
9337 struct bnx2x
*bp
= params
->bp
;
9338 u8 link_up
= 0, oc_port
= params
->port
;
9339 u16 link_status
= 0;
9340 u16 rx_alarm_status
, lasi_ctrl
, val1
;
9342 /* If PHY is not initialized, do not check link status */
9343 bnx2x_cl45_read(bp
, phy
,
9344 MDIO_PMA_DEVAD
, MDIO_PMA_LASI_CTRL
,
9349 /* Check the LASI on Rx */
9350 bnx2x_cl45_read(bp
, phy
,
9351 MDIO_PMA_DEVAD
, MDIO_PMA_LASI_RXSTAT
,
9353 vars
->line_speed
= 0;
9354 DP(NETIF_MSG_LINK
, "8727 RX_ALARM_STATUS 0x%x\n", rx_alarm_status
);
9356 bnx2x_sfp_mask_fault(bp
, phy
, MDIO_PMA_LASI_TXSTAT
,
9357 MDIO_PMA_LASI_TXCTRL
);
9359 bnx2x_cl45_read(bp
, phy
,
9360 MDIO_PMA_DEVAD
, MDIO_PMA_LASI_STAT
, &val1
);
9362 DP(NETIF_MSG_LINK
, "8727 LASI status 0x%x\n", val1
);
9365 bnx2x_cl45_read(bp
, phy
,
9366 MDIO_PMA_DEVAD
, MDIO_PMA_REG_M8051_MSGOUT_REG
, &val1
);
9368 /* If a module is present and there is need to check
9371 if (!(phy
->flags
& FLAGS_NOC
) && !(rx_alarm_status
& (1<<5))) {
9372 /* Check over-current using 8727 GPIO0 input*/
9373 bnx2x_cl45_read(bp
, phy
,
9374 MDIO_PMA_DEVAD
, MDIO_PMA_REG_8727_GPIO_CTRL
,
9377 if ((val1
& (1<<8)) == 0) {
9378 if (!CHIP_IS_E1x(bp
))
9379 oc_port
= BP_PATH(bp
) + (params
->port
<< 1);
9381 "8727 Power fault has been detected on port %d\n",
9383 netdev_err(bp
->dev
, "Error: Power fault on Port %d has "
9384 "been detected and the power to "
9385 "that SFP+ module has been removed "
9386 "to prevent failure of the card. "
9387 "Please remove the SFP+ module and "
9388 "restart the system to clear this "
9391 /* Disable all RX_ALARMs except for mod_abs */
9392 bnx2x_cl45_write(bp
, phy
,
9394 MDIO_PMA_LASI_RXCTRL
, (1<<5));
9396 bnx2x_cl45_read(bp
, phy
,
9398 MDIO_PMA_REG_PHY_IDENTIFIER
, &val1
);
9399 /* Wait for module_absent_event */
9401 bnx2x_cl45_write(bp
, phy
,
9403 MDIO_PMA_REG_PHY_IDENTIFIER
, val1
);
9404 /* Clear RX alarm */
9405 bnx2x_cl45_read(bp
, phy
,
9407 MDIO_PMA_LASI_RXSTAT
, &rx_alarm_status
);
9408 bnx2x_8727_power_module(params
->bp
, phy
, 0);
9411 } /* Over current check */
9413 /* When module absent bit is set, check module */
9414 if (rx_alarm_status
& (1<<5)) {
9415 bnx2x_8727_handle_mod_abs(phy
, params
);
9416 /* Enable all mod_abs and link detection bits */
9417 bnx2x_cl45_write(bp
, phy
,
9418 MDIO_PMA_DEVAD
, MDIO_PMA_LASI_RXCTRL
,
9422 if (!(phy
->flags
& FLAGS_SFP_NOT_APPROVED
)) {
9423 DP(NETIF_MSG_LINK
, "Enabling 8727 TX laser\n");
9424 bnx2x_sfp_set_transmitter(params
, phy
, 1);
9426 DP(NETIF_MSG_LINK
, "Tx is disabled\n");
9430 bnx2x_cl45_read(bp
, phy
,
9432 MDIO_PMA_REG_8073_SPEED_LINK_STATUS
, &link_status
);
9434 /* Bits 0..2 --> speed detected,
9435 * Bits 13..15--> link is down
9437 if ((link_status
& (1<<2)) && (!(link_status
& (1<<15)))) {
9439 vars
->line_speed
= SPEED_10000
;
9440 DP(NETIF_MSG_LINK
, "port %x: External link up in 10G\n",
9442 } else if ((link_status
& (1<<0)) && (!(link_status
& (1<<13)))) {
9444 vars
->line_speed
= SPEED_1000
;
9445 DP(NETIF_MSG_LINK
, "port %x: External link up in 1G\n",
9449 DP(NETIF_MSG_LINK
, "port %x: External link is down\n",
9453 /* Capture 10G link fault. */
9454 if (vars
->line_speed
== SPEED_10000
) {
9455 bnx2x_cl45_read(bp
, phy
, MDIO_PMA_DEVAD
,
9456 MDIO_PMA_LASI_TXSTAT
, &val1
);
9458 bnx2x_cl45_read(bp
, phy
, MDIO_PMA_DEVAD
,
9459 MDIO_PMA_LASI_TXSTAT
, &val1
);
9461 if (val1
& (1<<0)) {
9462 vars
->fault_detected
= 1;
9467 bnx2x_ext_phy_resolve_fc(phy
, params
, vars
);
9468 vars
->duplex
= DUPLEX_FULL
;
9469 DP(NETIF_MSG_LINK
, "duplex = 0x%x\n", vars
->duplex
);
9472 if ((DUAL_MEDIA(params
)) &&
9473 (phy
->req_line_speed
== SPEED_1000
)) {
9474 bnx2x_cl45_read(bp
, phy
,
9476 MDIO_PMA_REG_8727_PCS_GP
, &val1
);
9477 /* In case of dual-media board and 1G, power up the XAUI side,
9478 * otherwise power it down. For 10G it is done automatically
9484 bnx2x_cl45_write(bp
, phy
,
9486 MDIO_PMA_REG_8727_PCS_GP
, val1
);
9491 static void bnx2x_8727_link_reset(struct bnx2x_phy
*phy
,
9492 struct link_params
*params
)
9494 struct bnx2x
*bp
= params
->bp
;
9496 /* Enable/Disable PHY transmitter output */
9497 bnx2x_set_disable_pmd_transmit(params
, phy
, 1);
9499 /* Disable Transmitter */
9500 bnx2x_sfp_set_transmitter(params
, phy
, 0);
9502 bnx2x_cl45_write(bp
, phy
, MDIO_PMA_DEVAD
, MDIO_PMA_LASI_CTRL
, 0);
9506 /******************************************************************/
9507 /* BCM8481/BCM84823/BCM84833 PHY SECTION */
9508 /******************************************************************/
9509 static void bnx2x_save_848xx_spirom_version(struct bnx2x_phy
*phy
,
9513 u16 val
, fw_ver2
, cnt
, i
;
9514 static struct bnx2x_reg_set reg_set
[] = {
9515 {MDIO_PMA_DEVAD
, 0xA819, 0x0014},
9516 {MDIO_PMA_DEVAD
, 0xA81A, 0xc200},
9517 {MDIO_PMA_DEVAD
, 0xA81B, 0x0000},
9518 {MDIO_PMA_DEVAD
, 0xA81C, 0x0300},
9519 {MDIO_PMA_DEVAD
, 0xA817, 0x0009}
9523 if ((phy
->type
== PORT_HW_CFG_XGXS_EXT_PHY_TYPE_BCM84833
) ||
9524 (phy
->type
== PORT_HW_CFG_XGXS_EXT_PHY_TYPE_BCM84834
)) {
9525 bnx2x_cl45_read(bp
, phy
, MDIO_CTL_DEVAD
, 0x400f, &fw_ver1
);
9526 bnx2x_save_spirom_version(bp
, port
, fw_ver1
& 0xfff,
9529 /* For 32-bit registers in 848xx, access via MDIO2ARM i/f. */
9530 /* (1) set reg 0xc200_0014(SPI_BRIDGE_CTRL_2) to 0x03000000 */
9531 for (i
= 0; i
< ARRAY_SIZE(reg_set
);
9533 bnx2x_cl45_write(bp
, phy
, reg_set
[i
].devad
,
9534 reg_set
[i
].reg
, reg_set
[i
].val
);
9536 for (cnt
= 0; cnt
< 100; cnt
++) {
9537 bnx2x_cl45_read(bp
, phy
, MDIO_PMA_DEVAD
, 0xA818, &val
);
9543 DP(NETIF_MSG_LINK
, "Unable to read 848xx "
9544 "phy fw version(1)\n");
9545 bnx2x_save_spirom_version(bp
, port
, 0,
9551 /* 2) read register 0xc200_0000 (SPI_FW_STATUS) */
9552 bnx2x_cl45_write(bp
, phy
, MDIO_PMA_DEVAD
, 0xA819, 0x0000);
9553 bnx2x_cl45_write(bp
, phy
, MDIO_PMA_DEVAD
, 0xA81A, 0xc200);
9554 bnx2x_cl45_write(bp
, phy
, MDIO_PMA_DEVAD
, 0xA817, 0x000A);
9555 for (cnt
= 0; cnt
< 100; cnt
++) {
9556 bnx2x_cl45_read(bp
, phy
, MDIO_PMA_DEVAD
, 0xA818, &val
);
9562 DP(NETIF_MSG_LINK
, "Unable to read 848xx phy fw "
9564 bnx2x_save_spirom_version(bp
, port
, 0,
9569 /* lower 16 bits of the register SPI_FW_STATUS */
9570 bnx2x_cl45_read(bp
, phy
, MDIO_PMA_DEVAD
, 0xA81B, &fw_ver1
);
9571 /* upper 16 bits of register SPI_FW_STATUS */
9572 bnx2x_cl45_read(bp
, phy
, MDIO_PMA_DEVAD
, 0xA81C, &fw_ver2
);
9574 bnx2x_save_spirom_version(bp
, port
, (fw_ver2
<<16) | fw_ver1
,
9579 static void bnx2x_848xx_set_led(struct bnx2x
*bp
,
9580 struct bnx2x_phy
*phy
)
9583 static struct bnx2x_reg_set reg_set
[] = {
9584 {MDIO_PMA_DEVAD
, MDIO_PMA_REG_8481_LED1_MASK
, 0x0080},
9585 {MDIO_PMA_DEVAD
, MDIO_PMA_REG_8481_LED2_MASK
, 0x0018},
9586 {MDIO_PMA_DEVAD
, MDIO_PMA_REG_8481_LED3_MASK
, 0x0006},
9587 {MDIO_PMA_DEVAD
, MDIO_PMA_REG_8481_LED3_BLINK
, 0x0000},
9588 {MDIO_PMA_DEVAD
, MDIO_PMA_REG_84823_CTL_SLOW_CLK_CNT_HIGH
,
9589 MDIO_PMA_REG_84823_BLINK_RATE_VAL_15P9HZ
},
9590 {MDIO_AN_DEVAD
, 0xFFFB, 0xFFFD}
9592 /* PHYC_CTL_LED_CTL */
9593 bnx2x_cl45_read(bp
, phy
,
9595 MDIO_PMA_REG_8481_LINK_SIGNAL
, &val
);
9599 bnx2x_cl45_write(bp
, phy
,
9601 MDIO_PMA_REG_8481_LINK_SIGNAL
, val
);
9603 for (i
= 0; i
< ARRAY_SIZE(reg_set
); i
++)
9604 bnx2x_cl45_write(bp
, phy
, reg_set
[i
].devad
, reg_set
[i
].reg
,
9607 if ((phy
->type
== PORT_HW_CFG_XGXS_EXT_PHY_TYPE_BCM84833
) ||
9608 (phy
->type
== PORT_HW_CFG_XGXS_EXT_PHY_TYPE_BCM84834
))
9609 offset
= MDIO_PMA_REG_84833_CTL_LED_CTL_1
;
9611 offset
= MDIO_PMA_REG_84823_CTL_LED_CTL_1
;
9613 /* stretch_en for LED3*/
9614 bnx2x_cl45_read_or_write(bp
, phy
,
9615 MDIO_PMA_DEVAD
, offset
,
9616 MDIO_PMA_REG_84823_LED3_STRETCH_EN
);
9619 static void bnx2x_848xx_specific_func(struct bnx2x_phy
*phy
,
9620 struct link_params
*params
,
9623 struct bnx2x
*bp
= params
->bp
;
9626 if ((phy
->type
!= PORT_HW_CFG_XGXS_EXT_PHY_TYPE_BCM84833
) &&
9627 (phy
->type
!= PORT_HW_CFG_XGXS_EXT_PHY_TYPE_BCM84834
)) {
9628 /* Save spirom version */
9629 bnx2x_save_848xx_spirom_version(phy
, bp
, params
->port
);
9631 /* This phy uses the NIG latch mechanism since link indication
9632 * arrives through its LED4 and not via its LASI signal, so we
9633 * get steady signal instead of clear on read
9635 bnx2x_bits_en(bp
, NIG_REG_LATCH_BC_0
+ params
->port
*4,
9636 1 << NIG_LATCH_BC_ENABLE_MI_INT
);
9638 bnx2x_848xx_set_led(bp
, phy
);
9643 static int bnx2x_848xx_cmn_config_init(struct bnx2x_phy
*phy
,
9644 struct link_params
*params
,
9645 struct link_vars
*vars
)
9647 struct bnx2x
*bp
= params
->bp
;
9648 u16 autoneg_val
, an_1000_val
, an_10_100_val
;
9650 bnx2x_848xx_specific_func(phy
, params
, PHY_INIT
);
9651 bnx2x_cl45_write(bp
, phy
,
9652 MDIO_PMA_DEVAD
, MDIO_PMA_REG_CTRL
, 0x0000);
9654 /* set 1000 speed advertisement */
9655 bnx2x_cl45_read(bp
, phy
,
9656 MDIO_AN_DEVAD
, MDIO_AN_REG_8481_1000T_CTRL
,
9659 bnx2x_ext_phy_set_pause(params
, phy
, vars
);
9660 bnx2x_cl45_read(bp
, phy
,
9662 MDIO_AN_REG_8481_LEGACY_AN_ADV
,
9664 bnx2x_cl45_read(bp
, phy
,
9665 MDIO_AN_DEVAD
, MDIO_AN_REG_8481_LEGACY_MII_CTRL
,
9667 /* Disable forced speed */
9668 autoneg_val
&= ~((1<<6) | (1<<8) | (1<<9) | (1<<12) | (1<<13));
9669 an_10_100_val
&= ~((1<<5) | (1<<6) | (1<<7) | (1<<8));
9671 if (((phy
->req_line_speed
== SPEED_AUTO_NEG
) &&
9672 (phy
->speed_cap_mask
&
9673 PORT_HW_CFG_SPEED_CAPABILITY_D0_1G
)) ||
9674 (phy
->req_line_speed
== SPEED_1000
)) {
9675 an_1000_val
|= (1<<8);
9676 autoneg_val
|= (1<<9 | 1<<12);
9677 if (phy
->req_duplex
== DUPLEX_FULL
)
9678 an_1000_val
|= (1<<9);
9679 DP(NETIF_MSG_LINK
, "Advertising 1G\n");
9681 an_1000_val
&= ~((1<<8) | (1<<9));
9683 bnx2x_cl45_write(bp
, phy
,
9684 MDIO_AN_DEVAD
, MDIO_AN_REG_8481_1000T_CTRL
,
9687 /* set 100 speed advertisement */
9688 if ((phy
->req_line_speed
== SPEED_AUTO_NEG
) &&
9689 (phy
->speed_cap_mask
&
9690 (PORT_HW_CFG_SPEED_CAPABILITY_D0_100M_FULL
|
9691 PORT_HW_CFG_SPEED_CAPABILITY_D0_100M_HALF
))) {
9692 an_10_100_val
|= (1<<7);
9693 /* Enable autoneg and restart autoneg for legacy speeds */
9694 autoneg_val
|= (1<<9 | 1<<12);
9696 if (phy
->req_duplex
== DUPLEX_FULL
)
9697 an_10_100_val
|= (1<<8);
9698 DP(NETIF_MSG_LINK
, "Advertising 100M\n");
9700 /* set 10 speed advertisement */
9701 if (((phy
->req_line_speed
== SPEED_AUTO_NEG
) &&
9702 (phy
->speed_cap_mask
&
9703 (PORT_HW_CFG_SPEED_CAPABILITY_D0_10M_FULL
|
9704 PORT_HW_CFG_SPEED_CAPABILITY_D0_10M_HALF
)) &&
9706 (SUPPORTED_10baseT_Half
|
9707 SUPPORTED_10baseT_Full
)))) {
9708 an_10_100_val
|= (1<<5);
9709 autoneg_val
|= (1<<9 | 1<<12);
9710 if (phy
->req_duplex
== DUPLEX_FULL
)
9711 an_10_100_val
|= (1<<6);
9712 DP(NETIF_MSG_LINK
, "Advertising 10M\n");
9715 /* Only 10/100 are allowed to work in FORCE mode */
9716 if ((phy
->req_line_speed
== SPEED_100
) &&
9718 (SUPPORTED_100baseT_Half
|
9719 SUPPORTED_100baseT_Full
))) {
9720 autoneg_val
|= (1<<13);
9721 /* Enabled AUTO-MDIX when autoneg is disabled */
9722 bnx2x_cl45_write(bp
, phy
,
9723 MDIO_AN_DEVAD
, MDIO_AN_REG_8481_AUX_CTRL
,
9724 (1<<15 | 1<<9 | 7<<0));
9725 /* The PHY needs this set even for forced link. */
9726 an_10_100_val
|= (1<<8) | (1<<7);
9727 DP(NETIF_MSG_LINK
, "Setting 100M force\n");
9729 if ((phy
->req_line_speed
== SPEED_10
) &&
9731 (SUPPORTED_10baseT_Half
|
9732 SUPPORTED_10baseT_Full
))) {
9733 /* Enabled AUTO-MDIX when autoneg is disabled */
9734 bnx2x_cl45_write(bp
, phy
,
9735 MDIO_AN_DEVAD
, MDIO_AN_REG_8481_AUX_CTRL
,
9736 (1<<15 | 1<<9 | 7<<0));
9737 DP(NETIF_MSG_LINK
, "Setting 10M force\n");
9740 bnx2x_cl45_write(bp
, phy
,
9741 MDIO_AN_DEVAD
, MDIO_AN_REG_8481_LEGACY_AN_ADV
,
9744 if (phy
->req_duplex
== DUPLEX_FULL
)
9745 autoneg_val
|= (1<<8);
9747 /* Always write this if this is not 84833/4.
9748 * For 84833/4, write it only when it's a forced speed.
9750 if (((phy
->type
!= PORT_HW_CFG_XGXS_EXT_PHY_TYPE_BCM84833
) &&
9751 (phy
->type
!= PORT_HW_CFG_XGXS_EXT_PHY_TYPE_BCM84834
)) ||
9752 ((autoneg_val
& (1<<12)) == 0))
9753 bnx2x_cl45_write(bp
, phy
,
9755 MDIO_AN_REG_8481_LEGACY_MII_CTRL
, autoneg_val
);
9757 if (((phy
->req_line_speed
== SPEED_AUTO_NEG
) &&
9758 (phy
->speed_cap_mask
&
9759 PORT_HW_CFG_SPEED_CAPABILITY_D0_10G
)) ||
9760 (phy
->req_line_speed
== SPEED_10000
)) {
9761 DP(NETIF_MSG_LINK
, "Advertising 10G\n");
9762 /* Restart autoneg for 10G*/
9764 bnx2x_cl45_read_or_write(
9767 MDIO_AN_REG_8481_10GBASE_T_AN_CTRL
,
9769 bnx2x_cl45_write(bp
, phy
,
9770 MDIO_AN_DEVAD
, MDIO_AN_REG_CTRL
,
9773 bnx2x_cl45_write(bp
, phy
,
9775 MDIO_AN_REG_8481_10GBASE_T_AN_CTRL
,
9781 static int bnx2x_8481_config_init(struct bnx2x_phy
*phy
,
9782 struct link_params
*params
,
9783 struct link_vars
*vars
)
9785 struct bnx2x
*bp
= params
->bp
;
9786 /* Restore normal power mode*/
9787 bnx2x_set_gpio(bp
, MISC_REGISTERS_GPIO_2
,
9788 MISC_REGISTERS_GPIO_OUTPUT_HIGH
, params
->port
);
9791 bnx2x_ext_phy_hw_reset(bp
, params
->port
);
9792 bnx2x_wait_reset_complete(bp
, phy
, params
);
9794 bnx2x_cl45_write(bp
, phy
, MDIO_PMA_DEVAD
, MDIO_PMA_REG_CTRL
, 1<<15);
9795 return bnx2x_848xx_cmn_config_init(phy
, params
, vars
);
9798 #define PHY84833_CMDHDLR_WAIT 300
9799 #define PHY84833_CMDHDLR_MAX_ARGS 5
9800 static int bnx2x_84833_cmd_hdlr(struct bnx2x_phy
*phy
,
9801 struct link_params
*params
, u16 fw_cmd
,
9802 u16 cmd_args
[], int argc
)
9806 struct bnx2x
*bp
= params
->bp
;
9807 /* Write CMD_OPEN_OVERRIDE to STATUS reg */
9808 bnx2x_cl45_write(bp
, phy
, MDIO_CTL_DEVAD
,
9809 MDIO_84833_CMD_HDLR_STATUS
,
9810 PHY84833_STATUS_CMD_OPEN_OVERRIDE
);
9811 for (idx
= 0; idx
< PHY84833_CMDHDLR_WAIT
; idx
++) {
9812 bnx2x_cl45_read(bp
, phy
, MDIO_CTL_DEVAD
,
9813 MDIO_84833_CMD_HDLR_STATUS
, &val
);
9814 if (val
== PHY84833_STATUS_CMD_OPEN_FOR_CMDS
)
9816 usleep_range(1000, 2000);
9818 if (idx
>= PHY84833_CMDHDLR_WAIT
) {
9819 DP(NETIF_MSG_LINK
, "FW cmd: FW not ready.\n");
9823 /* Prepare argument(s) and issue command */
9824 for (idx
= 0; idx
< argc
; idx
++) {
9825 bnx2x_cl45_write(bp
, phy
, MDIO_CTL_DEVAD
,
9826 MDIO_84833_CMD_HDLR_DATA1
+ idx
,
9829 bnx2x_cl45_write(bp
, phy
, MDIO_CTL_DEVAD
,
9830 MDIO_84833_CMD_HDLR_COMMAND
, fw_cmd
);
9831 for (idx
= 0; idx
< PHY84833_CMDHDLR_WAIT
; idx
++) {
9832 bnx2x_cl45_read(bp
, phy
, MDIO_CTL_DEVAD
,
9833 MDIO_84833_CMD_HDLR_STATUS
, &val
);
9834 if ((val
== PHY84833_STATUS_CMD_COMPLETE_PASS
) ||
9835 (val
== PHY84833_STATUS_CMD_COMPLETE_ERROR
))
9837 usleep_range(1000, 2000);
9839 if ((idx
>= PHY84833_CMDHDLR_WAIT
) ||
9840 (val
== PHY84833_STATUS_CMD_COMPLETE_ERROR
)) {
9841 DP(NETIF_MSG_LINK
, "FW cmd failed.\n");
9844 /* Gather returning data */
9845 for (idx
= 0; idx
< argc
; idx
++) {
9846 bnx2x_cl45_read(bp
, phy
, MDIO_CTL_DEVAD
,
9847 MDIO_84833_CMD_HDLR_DATA1
+ idx
,
9850 bnx2x_cl45_write(bp
, phy
, MDIO_CTL_DEVAD
,
9851 MDIO_84833_CMD_HDLR_STATUS
,
9852 PHY84833_STATUS_CMD_CLEAR_COMPLETE
);
9856 static int bnx2x_84833_pair_swap_cfg(struct bnx2x_phy
*phy
,
9857 struct link_params
*params
,
9858 struct link_vars
*vars
)
9861 u16 data
[PHY84833_CMDHDLR_MAX_ARGS
];
9863 struct bnx2x
*bp
= params
->bp
;
9865 /* Check for configuration. */
9866 pair_swap
= REG_RD(bp
, params
->shmem_base
+
9867 offsetof(struct shmem_region
,
9868 dev_info
.port_hw_config
[params
->port
].xgbt_phy_cfg
)) &
9869 PORT_HW_CFG_RJ45_PAIR_SWAP_MASK
;
9874 /* Only the second argument is used for this command */
9875 data
[1] = (u16
)pair_swap
;
9877 status
= bnx2x_84833_cmd_hdlr(phy
, params
,
9878 PHY84833_CMD_SET_PAIR_SWAP
, data
, PHY84833_CMDHDLR_MAX_ARGS
);
9880 DP(NETIF_MSG_LINK
, "Pairswap OK, val=0x%x\n", data
[1]);
9885 static u8
bnx2x_84833_get_reset_gpios(struct bnx2x
*bp
,
9886 u32 shmem_base_path
[],
9892 if (CHIP_IS_E3(bp
)) {
9893 /* Assume that these will be GPIOs, not EPIOs. */
9894 for (idx
= 0; idx
< 2; idx
++) {
9895 /* Map config param to register bit. */
9896 reset_pin
[idx
] = REG_RD(bp
, shmem_base_path
[idx
] +
9897 offsetof(struct shmem_region
,
9898 dev_info
.port_hw_config
[0].e3_cmn_pin_cfg
));
9899 reset_pin
[idx
] = (reset_pin
[idx
] &
9900 PORT_HW_CFG_E3_PHY_RESET_MASK
) >>
9901 PORT_HW_CFG_E3_PHY_RESET_SHIFT
;
9902 reset_pin
[idx
] -= PIN_CFG_GPIO0_P0
;
9903 reset_pin
[idx
] = (1 << reset_pin
[idx
]);
9905 reset_gpios
= (u8
)(reset_pin
[0] | reset_pin
[1]);
9907 /* E2, look from diff place of shmem. */
9908 for (idx
= 0; idx
< 2; idx
++) {
9909 reset_pin
[idx
] = REG_RD(bp
, shmem_base_path
[idx
] +
9910 offsetof(struct shmem_region
,
9911 dev_info
.port_hw_config
[0].default_cfg
));
9912 reset_pin
[idx
] &= PORT_HW_CFG_EXT_PHY_GPIO_RST_MASK
;
9913 reset_pin
[idx
] -= PORT_HW_CFG_EXT_PHY_GPIO_RST_GPIO0_P0
;
9914 reset_pin
[idx
] >>= PORT_HW_CFG_EXT_PHY_GPIO_RST_SHIFT
;
9915 reset_pin
[idx
] = (1 << reset_pin
[idx
]);
9917 reset_gpios
= (u8
)(reset_pin
[0] | reset_pin
[1]);
9923 static int bnx2x_84833_hw_reset_phy(struct bnx2x_phy
*phy
,
9924 struct link_params
*params
)
9926 struct bnx2x
*bp
= params
->bp
;
9928 u32 other_shmem_base_addr
= REG_RD(bp
, params
->shmem2_base
+
9929 offsetof(struct shmem2_region
,
9930 other_shmem_base_addr
));
9932 u32 shmem_base_path
[2];
9934 /* Work around for 84833 LED failure inside RESET status */
9935 bnx2x_cl45_write(bp
, phy
, MDIO_AN_DEVAD
,
9936 MDIO_AN_REG_8481_LEGACY_MII_CTRL
,
9937 MDIO_AN_REG_8481_MII_CTRL_FORCE_1G
);
9938 bnx2x_cl45_write(bp
, phy
, MDIO_AN_DEVAD
,
9939 MDIO_AN_REG_8481_1G_100T_EXT_CTRL
,
9940 MIDO_AN_REG_8481_EXT_CTRL_FORCE_LEDS_OFF
);
9942 shmem_base_path
[0] = params
->shmem_base
;
9943 shmem_base_path
[1] = other_shmem_base_addr
;
9945 reset_gpios
= bnx2x_84833_get_reset_gpios(bp
, shmem_base_path
,
9948 bnx2x_set_mult_gpio(bp
, reset_gpios
, MISC_REGISTERS_GPIO_OUTPUT_LOW
);
9950 DP(NETIF_MSG_LINK
, "84833 hw reset on pin values 0x%x\n",
9956 static int bnx2x_8483x_disable_eee(struct bnx2x_phy
*phy
,
9957 struct link_params
*params
,
9958 struct link_vars
*vars
)
9961 struct bnx2x
*bp
= params
->bp
;
9964 DP(NETIF_MSG_LINK
, "Don't Advertise 10GBase-T EEE\n");
9966 /* Prevent Phy from working in EEE and advertising it */
9967 rc
= bnx2x_84833_cmd_hdlr(phy
, params
,
9968 PHY84833_CMD_SET_EEE_MODE
, &cmd_args
, 1);
9970 DP(NETIF_MSG_LINK
, "EEE disable failed.\n");
9974 return bnx2x_eee_disable(phy
, params
, vars
);
9977 static int bnx2x_8483x_enable_eee(struct bnx2x_phy
*phy
,
9978 struct link_params
*params
,
9979 struct link_vars
*vars
)
9982 struct bnx2x
*bp
= params
->bp
;
9985 rc
= bnx2x_84833_cmd_hdlr(phy
, params
,
9986 PHY84833_CMD_SET_EEE_MODE
, &cmd_args
, 1);
9988 DP(NETIF_MSG_LINK
, "EEE enable failed.\n");
9992 return bnx2x_eee_advertise(phy
, params
, vars
, SHMEM_EEE_10G_ADV
);
9995 #define PHY84833_CONSTANT_LATENCY 1193
9996 static int bnx2x_848x3_config_init(struct bnx2x_phy
*phy
,
9997 struct link_params
*params
,
9998 struct link_vars
*vars
)
10000 struct bnx2x
*bp
= params
->bp
;
10001 u8 port
, initialize
= 1;
10003 u32 actual_phy_selection
;
10004 u16 cmd_args
[PHY84833_CMDHDLR_MAX_ARGS
];
10007 usleep_range(1000, 2000);
10009 if (!(CHIP_IS_E1x(bp
)))
10010 port
= BP_PATH(bp
);
10012 port
= params
->port
;
10014 if (phy
->type
== PORT_HW_CFG_XGXS_EXT_PHY_TYPE_BCM84823
) {
10015 bnx2x_set_gpio(bp
, MISC_REGISTERS_GPIO_3
,
10016 MISC_REGISTERS_GPIO_OUTPUT_HIGH
,
10020 bnx2x_cl45_write(bp
, phy
,
10022 MDIO_PMA_REG_CTRL
, 0x8000);
10025 bnx2x_wait_reset_complete(bp
, phy
, params
);
10027 /* Wait for GPHY to come out of reset */
10029 if ((phy
->type
!= PORT_HW_CFG_XGXS_EXT_PHY_TYPE_BCM84833
) &&
10030 (phy
->type
!= PORT_HW_CFG_XGXS_EXT_PHY_TYPE_BCM84834
)) {
10031 /* BCM84823 requires that XGXS links up first @ 10G for normal
10035 temp
= vars
->line_speed
;
10036 vars
->line_speed
= SPEED_10000
;
10037 bnx2x_set_autoneg(¶ms
->phy
[INT_PHY
], params
, vars
, 0);
10038 bnx2x_program_serdes(¶ms
->phy
[INT_PHY
], params
, vars
);
10039 vars
->line_speed
= temp
;
10042 bnx2x_cl45_read(bp
, phy
, MDIO_CTL_DEVAD
,
10043 MDIO_CTL_REG_84823_MEDIA
, &val
);
10044 val
&= ~(MDIO_CTL_REG_84823_MEDIA_MAC_MASK
|
10045 MDIO_CTL_REG_84823_MEDIA_LINE_MASK
|
10046 MDIO_CTL_REG_84823_MEDIA_COPPER_CORE_DOWN
|
10047 MDIO_CTL_REG_84823_MEDIA_PRIORITY_MASK
|
10048 MDIO_CTL_REG_84823_MEDIA_FIBER_1G
);
10050 if (CHIP_IS_E3(bp
)) {
10051 val
&= ~(MDIO_CTL_REG_84823_MEDIA_MAC_MASK
|
10052 MDIO_CTL_REG_84823_MEDIA_LINE_MASK
);
10054 val
|= (MDIO_CTL_REG_84823_CTRL_MAC_XFI
|
10055 MDIO_CTL_REG_84823_MEDIA_LINE_XAUI_L
);
10058 actual_phy_selection
= bnx2x_phy_selection(params
);
10060 switch (actual_phy_selection
) {
10061 case PORT_HW_CFG_PHY_SELECTION_HARDWARE_DEFAULT
:
10062 /* Do nothing. Essentially this is like the priority copper */
10064 case PORT_HW_CFG_PHY_SELECTION_FIRST_PHY_PRIORITY
:
10065 val
|= MDIO_CTL_REG_84823_MEDIA_PRIORITY_COPPER
;
10067 case PORT_HW_CFG_PHY_SELECTION_SECOND_PHY_PRIORITY
:
10068 val
|= MDIO_CTL_REG_84823_MEDIA_PRIORITY_FIBER
;
10070 case PORT_HW_CFG_PHY_SELECTION_FIRST_PHY
:
10071 /* Do nothing here. The first PHY won't be initialized at all */
10073 case PORT_HW_CFG_PHY_SELECTION_SECOND_PHY
:
10074 val
|= MDIO_CTL_REG_84823_MEDIA_COPPER_CORE_DOWN
;
10078 if (params
->phy
[EXT_PHY2
].req_line_speed
== SPEED_1000
)
10079 val
|= MDIO_CTL_REG_84823_MEDIA_FIBER_1G
;
10081 bnx2x_cl45_write(bp
, phy
, MDIO_CTL_DEVAD
,
10082 MDIO_CTL_REG_84823_MEDIA
, val
);
10083 DP(NETIF_MSG_LINK
, "Multi_phy config = 0x%x, Media control = 0x%x\n",
10084 params
->multi_phy_config
, val
);
10086 if ((phy
->type
== PORT_HW_CFG_XGXS_EXT_PHY_TYPE_BCM84833
) ||
10087 (phy
->type
== PORT_HW_CFG_XGXS_EXT_PHY_TYPE_BCM84834
)) {
10088 bnx2x_84833_pair_swap_cfg(phy
, params
, vars
);
10090 /* Keep AutogrEEEn disabled. */
10093 cmd_args
[2] = PHY84833_CONSTANT_LATENCY
+ 1;
10094 cmd_args
[3] = PHY84833_CONSTANT_LATENCY
;
10095 rc
= bnx2x_84833_cmd_hdlr(phy
, params
,
10096 PHY84833_CMD_SET_EEE_MODE
, cmd_args
,
10097 PHY84833_CMDHDLR_MAX_ARGS
);
10099 DP(NETIF_MSG_LINK
, "Cfg AutogrEEEn failed.\n");
10102 rc
= bnx2x_848xx_cmn_config_init(phy
, params
, vars
);
10104 bnx2x_save_848xx_spirom_version(phy
, bp
, params
->port
);
10105 /* 84833 PHY has a better feature and doesn't need to support this. */
10106 if (phy
->type
== PORT_HW_CFG_XGXS_EXT_PHY_TYPE_BCM84823
) {
10107 u32 cms_enable
= REG_RD(bp
, params
->shmem_base
+
10108 offsetof(struct shmem_region
,
10109 dev_info
.port_hw_config
[params
->port
].default_cfg
)) &
10110 PORT_HW_CFG_ENABLE_CMS_MASK
;
10112 bnx2x_cl45_read(bp
, phy
, MDIO_CTL_DEVAD
,
10113 MDIO_CTL_REG_84823_USER_CTRL_REG
, &val
);
10115 val
|= MDIO_CTL_REG_84823_USER_CTRL_CMS
;
10117 val
&= ~MDIO_CTL_REG_84823_USER_CTRL_CMS
;
10118 bnx2x_cl45_write(bp
, phy
, MDIO_CTL_DEVAD
,
10119 MDIO_CTL_REG_84823_USER_CTRL_REG
, val
);
10122 bnx2x_cl45_read(bp
, phy
, MDIO_CTL_DEVAD
,
10123 MDIO_84833_TOP_CFG_FW_REV
, &val
);
10125 /* Configure EEE support */
10126 if ((val
>= MDIO_84833_TOP_CFG_FW_EEE
) &&
10127 (val
!= MDIO_84833_TOP_CFG_FW_NO_EEE
) &&
10128 bnx2x_eee_has_cap(params
)) {
10129 rc
= bnx2x_eee_initial_config(params
, vars
, SHMEM_EEE_10G_ADV
);
10131 DP(NETIF_MSG_LINK
, "Failed to configure EEE timers\n");
10132 bnx2x_8483x_disable_eee(phy
, params
, vars
);
10136 if ((phy
->req_duplex
== DUPLEX_FULL
) &&
10137 (params
->eee_mode
& EEE_MODE_ADV_LPI
) &&
10138 (bnx2x_eee_calc_timer(params
) ||
10139 !(params
->eee_mode
& EEE_MODE_ENABLE_LPI
)))
10140 rc
= bnx2x_8483x_enable_eee(phy
, params
, vars
);
10142 rc
= bnx2x_8483x_disable_eee(phy
, params
, vars
);
10144 DP(NETIF_MSG_LINK
, "Failed to set EEE advertisement\n");
10148 vars
->eee_status
&= ~SHMEM_EEE_SUPPORTED_MASK
;
10151 if ((phy
->type
== PORT_HW_CFG_XGXS_EXT_PHY_TYPE_BCM84833
) ||
10152 (phy
->type
== PORT_HW_CFG_XGXS_EXT_PHY_TYPE_BCM84834
)) {
10153 /* Bring PHY out of super isolate mode as the final step. */
10154 bnx2x_cl45_read_and_write(bp
, phy
,
10156 MDIO_84833_TOP_CFG_XGPHY_STRAP1
,
10157 (u16
)~MDIO_84833_SUPER_ISOLATE
);
10162 static u8
bnx2x_848xx_read_status(struct bnx2x_phy
*phy
,
10163 struct link_params
*params
,
10164 struct link_vars
*vars
)
10166 struct bnx2x
*bp
= params
->bp
;
10167 u16 val
, val1
, val2
;
10171 /* Check 10G-BaseT link status */
10172 /* Check PMD signal ok */
10173 bnx2x_cl45_read(bp
, phy
,
10174 MDIO_AN_DEVAD
, 0xFFFA, &val1
);
10175 bnx2x_cl45_read(bp
, phy
,
10176 MDIO_PMA_DEVAD
, MDIO_PMA_REG_8481_PMD_SIGNAL
,
10178 DP(NETIF_MSG_LINK
, "BCM848xx: PMD_SIGNAL 1.a811 = 0x%x\n", val2
);
10180 /* Check link 10G */
10181 if (val2
& (1<<11)) {
10182 vars
->line_speed
= SPEED_10000
;
10183 vars
->duplex
= DUPLEX_FULL
;
10185 bnx2x_ext_phy_10G_an_resolve(bp
, phy
, vars
);
10186 } else { /* Check Legacy speed link */
10187 u16 legacy_status
, legacy_speed
;
10189 /* Enable expansion register 0x42 (Operation mode status) */
10190 bnx2x_cl45_write(bp
, phy
,
10192 MDIO_AN_REG_8481_EXPANSION_REG_ACCESS
, 0xf42);
10194 /* Get legacy speed operation status */
10195 bnx2x_cl45_read(bp
, phy
,
10197 MDIO_AN_REG_8481_EXPANSION_REG_RD_RW
,
10200 DP(NETIF_MSG_LINK
, "Legacy speed status = 0x%x\n",
10202 link_up
= ((legacy_status
& (1<<11)) == (1<<11));
10203 legacy_speed
= (legacy_status
& (3<<9));
10204 if (legacy_speed
== (0<<9))
10205 vars
->line_speed
= SPEED_10
;
10206 else if (legacy_speed
== (1<<9))
10207 vars
->line_speed
= SPEED_100
;
10208 else if (legacy_speed
== (2<<9))
10209 vars
->line_speed
= SPEED_1000
;
10210 else { /* Should not happen: Treat as link down */
10211 vars
->line_speed
= 0;
10216 if (legacy_status
& (1<<8))
10217 vars
->duplex
= DUPLEX_FULL
;
10219 vars
->duplex
= DUPLEX_HALF
;
10222 "Link is up in %dMbps, is_duplex_full= %d\n",
10224 (vars
->duplex
== DUPLEX_FULL
));
10225 /* Check legacy speed AN resolution */
10226 bnx2x_cl45_read(bp
, phy
,
10228 MDIO_AN_REG_8481_LEGACY_MII_STATUS
,
10231 vars
->link_status
|=
10232 LINK_STATUS_AUTO_NEGOTIATE_COMPLETE
;
10233 bnx2x_cl45_read(bp
, phy
,
10235 MDIO_AN_REG_8481_LEGACY_AN_EXPANSION
,
10237 if ((val
& (1<<0)) == 0)
10238 vars
->link_status
|=
10239 LINK_STATUS_PARALLEL_DETECTION_USED
;
10243 DP(NETIF_MSG_LINK
, "BCM848x3: link speed is %d\n",
10245 bnx2x_ext_phy_resolve_fc(phy
, params
, vars
);
10247 /* Read LP advertised speeds */
10248 bnx2x_cl45_read(bp
, phy
, MDIO_AN_DEVAD
,
10249 MDIO_AN_REG_CL37_FC_LP
, &val
);
10251 vars
->link_status
|=
10252 LINK_STATUS_LINK_PARTNER_10THD_CAPABLE
;
10254 vars
->link_status
|=
10255 LINK_STATUS_LINK_PARTNER_10TFD_CAPABLE
;
10257 vars
->link_status
|=
10258 LINK_STATUS_LINK_PARTNER_100TXHD_CAPABLE
;
10260 vars
->link_status
|=
10261 LINK_STATUS_LINK_PARTNER_100TXFD_CAPABLE
;
10263 vars
->link_status
|=
10264 LINK_STATUS_LINK_PARTNER_100T4_CAPABLE
;
10266 bnx2x_cl45_read(bp
, phy
, MDIO_AN_DEVAD
,
10267 MDIO_AN_REG_1000T_STATUS
, &val
);
10270 vars
->link_status
|=
10271 LINK_STATUS_LINK_PARTNER_1000THD_CAPABLE
;
10273 vars
->link_status
|=
10274 LINK_STATUS_LINK_PARTNER_1000TFD_CAPABLE
;
10276 bnx2x_cl45_read(bp
, phy
, MDIO_AN_DEVAD
,
10277 MDIO_AN_REG_MASTER_STATUS
, &val
);
10280 vars
->link_status
|=
10281 LINK_STATUS_LINK_PARTNER_10GXFD_CAPABLE
;
10283 /* Determine if EEE was negotiated */
10284 if (phy
->type
== PORT_HW_CFG_XGXS_EXT_PHY_TYPE_BCM84833
)
10285 bnx2x_eee_an_resolve(phy
, params
, vars
);
10291 static int bnx2x_848xx_format_ver(u32 raw_ver
, u8
*str
, u16
*len
)
10295 spirom_ver
= ((raw_ver
& 0xF80) >> 7) << 16 | (raw_ver
& 0x7F);
10296 status
= bnx2x_format_ver(spirom_ver
, str
, len
);
10300 static void bnx2x_8481_hw_reset(struct bnx2x_phy
*phy
,
10301 struct link_params
*params
)
10303 bnx2x_set_gpio(params
->bp
, MISC_REGISTERS_GPIO_1
,
10304 MISC_REGISTERS_GPIO_OUTPUT_LOW
, 0);
10305 bnx2x_set_gpio(params
->bp
, MISC_REGISTERS_GPIO_1
,
10306 MISC_REGISTERS_GPIO_OUTPUT_LOW
, 1);
10309 static void bnx2x_8481_link_reset(struct bnx2x_phy
*phy
,
10310 struct link_params
*params
)
10312 bnx2x_cl45_write(params
->bp
, phy
,
10313 MDIO_AN_DEVAD
, MDIO_AN_REG_CTRL
, 0x0000);
10314 bnx2x_cl45_write(params
->bp
, phy
,
10315 MDIO_PMA_DEVAD
, MDIO_PMA_REG_CTRL
, 1);
10318 static void bnx2x_848x3_link_reset(struct bnx2x_phy
*phy
,
10319 struct link_params
*params
)
10321 struct bnx2x
*bp
= params
->bp
;
10325 if (!(CHIP_IS_E1x(bp
)))
10326 port
= BP_PATH(bp
);
10328 port
= params
->port
;
10330 if (phy
->type
== PORT_HW_CFG_XGXS_EXT_PHY_TYPE_BCM84823
) {
10331 bnx2x_set_gpio(bp
, MISC_REGISTERS_GPIO_3
,
10332 MISC_REGISTERS_GPIO_OUTPUT_LOW
,
10335 bnx2x_cl45_read(bp
, phy
,
10337 MDIO_84833_TOP_CFG_XGPHY_STRAP1
, &val16
);
10338 val16
|= MDIO_84833_SUPER_ISOLATE
;
10339 bnx2x_cl45_write(bp
, phy
,
10341 MDIO_84833_TOP_CFG_XGPHY_STRAP1
, val16
);
10345 static void bnx2x_848xx_set_link_led(struct bnx2x_phy
*phy
,
10346 struct link_params
*params
, u8 mode
)
10348 struct bnx2x
*bp
= params
->bp
;
10352 if (!(CHIP_IS_E1x(bp
)))
10353 port
= BP_PATH(bp
);
10355 port
= params
->port
;
10360 DP(NETIF_MSG_LINK
, "Port 0x%x: LED MODE OFF\n", port
);
10362 if ((params
->hw_led_mode
<< SHARED_HW_CFG_LED_MODE_SHIFT
) ==
10363 SHARED_HW_CFG_LED_EXTPHY1
) {
10365 /* Set LED masks */
10366 bnx2x_cl45_write(bp
, phy
,
10368 MDIO_PMA_REG_8481_LED1_MASK
,
10371 bnx2x_cl45_write(bp
, phy
,
10373 MDIO_PMA_REG_8481_LED2_MASK
,
10376 bnx2x_cl45_write(bp
, phy
,
10378 MDIO_PMA_REG_8481_LED3_MASK
,
10381 bnx2x_cl45_write(bp
, phy
,
10383 MDIO_PMA_REG_8481_LED5_MASK
,
10387 bnx2x_cl45_write(bp
, phy
,
10389 MDIO_PMA_REG_8481_LED1_MASK
,
10393 case LED_MODE_FRONT_PANEL_OFF
:
10395 DP(NETIF_MSG_LINK
, "Port 0x%x: LED MODE FRONT PANEL OFF\n",
10398 if ((params
->hw_led_mode
<< SHARED_HW_CFG_LED_MODE_SHIFT
) ==
10399 SHARED_HW_CFG_LED_EXTPHY1
) {
10401 /* Set LED masks */
10402 bnx2x_cl45_write(bp
, phy
,
10404 MDIO_PMA_REG_8481_LED1_MASK
,
10407 bnx2x_cl45_write(bp
, phy
,
10409 MDIO_PMA_REG_8481_LED2_MASK
,
10412 bnx2x_cl45_write(bp
, phy
,
10414 MDIO_PMA_REG_8481_LED3_MASK
,
10417 bnx2x_cl45_write(bp
, phy
,
10419 MDIO_PMA_REG_8481_LED5_MASK
,
10423 bnx2x_cl45_write(bp
, phy
,
10425 MDIO_PMA_REG_8481_LED1_MASK
,
10428 PORT_HW_CFG_XGXS_EXT_PHY_TYPE_BCM84834
) {
10429 /* Disable MI_INT interrupt before setting LED4
10430 * source to constant off.
10432 if (REG_RD(bp
, NIG_REG_MASK_INTERRUPT_PORT0
+
10435 params
->link_flags
|=
10436 LINK_FLAGS_INT_DISABLED
;
10440 NIG_REG_MASK_INTERRUPT_PORT0
+
10444 bnx2x_cl45_write(bp
, phy
,
10446 MDIO_PMA_REG_8481_SIGNAL_MASK
,
10453 DP(NETIF_MSG_LINK
, "Port 0x%x: LED MODE ON\n", port
);
10455 if ((params
->hw_led_mode
<< SHARED_HW_CFG_LED_MODE_SHIFT
) ==
10456 SHARED_HW_CFG_LED_EXTPHY1
) {
10457 /* Set control reg */
10458 bnx2x_cl45_read(bp
, phy
,
10460 MDIO_PMA_REG_8481_LINK_SIGNAL
,
10465 bnx2x_cl45_write(bp
, phy
,
10467 MDIO_PMA_REG_8481_LINK_SIGNAL
,
10470 /* Set LED masks */
10471 bnx2x_cl45_write(bp
, phy
,
10473 MDIO_PMA_REG_8481_LED1_MASK
,
10476 bnx2x_cl45_write(bp
, phy
,
10478 MDIO_PMA_REG_8481_LED2_MASK
,
10481 bnx2x_cl45_write(bp
, phy
,
10483 MDIO_PMA_REG_8481_LED3_MASK
,
10486 bnx2x_cl45_write(bp
, phy
,
10488 MDIO_PMA_REG_8481_LED5_MASK
,
10491 bnx2x_cl45_write(bp
, phy
,
10493 MDIO_PMA_REG_8481_LED1_MASK
,
10496 PORT_HW_CFG_XGXS_EXT_PHY_TYPE_BCM84834
) {
10497 /* Disable MI_INT interrupt before setting LED4
10498 * source to constant on.
10500 if (REG_RD(bp
, NIG_REG_MASK_INTERRUPT_PORT0
+
10503 params
->link_flags
|=
10504 LINK_FLAGS_INT_DISABLED
;
10508 NIG_REG_MASK_INTERRUPT_PORT0
+
10512 bnx2x_cl45_write(bp
, phy
,
10514 MDIO_PMA_REG_8481_SIGNAL_MASK
,
10520 case LED_MODE_OPER
:
10522 DP(NETIF_MSG_LINK
, "Port 0x%x: LED MODE OPER\n", port
);
10524 if ((params
->hw_led_mode
<< SHARED_HW_CFG_LED_MODE_SHIFT
) ==
10525 SHARED_HW_CFG_LED_EXTPHY1
) {
10527 /* Set control reg */
10528 bnx2x_cl45_read(bp
, phy
,
10530 MDIO_PMA_REG_8481_LINK_SIGNAL
,
10534 MDIO_PMA_REG_8481_LINK_SIGNAL_LED4_ENABLE_MASK
)
10535 >> MDIO_PMA_REG_8481_LINK_SIGNAL_LED4_ENABLE_SHIFT
)) {
10536 DP(NETIF_MSG_LINK
, "Setting LINK_SIGNAL\n");
10537 bnx2x_cl45_write(bp
, phy
,
10539 MDIO_PMA_REG_8481_LINK_SIGNAL
,
10543 /* Set LED masks */
10544 bnx2x_cl45_write(bp
, phy
,
10546 MDIO_PMA_REG_8481_LED1_MASK
,
10549 bnx2x_cl45_write(bp
, phy
,
10551 MDIO_PMA_REG_8481_LED2_MASK
,
10554 bnx2x_cl45_write(bp
, phy
,
10556 MDIO_PMA_REG_8481_LED3_MASK
,
10559 bnx2x_cl45_write(bp
, phy
,
10561 MDIO_PMA_REG_8481_LED5_MASK
,
10565 bnx2x_cl45_write(bp
, phy
,
10567 MDIO_PMA_REG_8481_LED1_MASK
,
10570 /* Tell LED3 to blink on source */
10571 bnx2x_cl45_read(bp
, phy
,
10573 MDIO_PMA_REG_8481_LINK_SIGNAL
,
10576 val
|= (1<<6); /* A83B[8:6]= 1 */
10577 bnx2x_cl45_write(bp
, phy
,
10579 MDIO_PMA_REG_8481_LINK_SIGNAL
,
10582 PORT_HW_CFG_XGXS_EXT_PHY_TYPE_BCM84834
) {
10583 /* Restore LED4 source to external link,
10584 * and re-enable interrupts.
10586 bnx2x_cl45_write(bp
, phy
,
10588 MDIO_PMA_REG_8481_SIGNAL_MASK
,
10590 if (params
->link_flags
&
10591 LINK_FLAGS_INT_DISABLED
) {
10592 bnx2x_link_int_enable(params
);
10593 params
->link_flags
&=
10594 ~LINK_FLAGS_INT_DISABLED
;
10601 /* This is a workaround for E3+84833 until autoneg
10602 * restart is fixed in f/w
10604 if (CHIP_IS_E3(bp
)) {
10605 bnx2x_cl45_read(bp
, phy
, MDIO_WC_DEVAD
,
10606 MDIO_WC_REG_GP2_STATUS_GP_2_1
, &val
);
10610 /******************************************************************/
10611 /* 54618SE PHY SECTION */
10612 /******************************************************************/
10613 static void bnx2x_54618se_specific_func(struct bnx2x_phy
*phy
,
10614 struct link_params
*params
,
10617 struct bnx2x
*bp
= params
->bp
;
10621 /* Configure LED4: set to INTR (0x6). */
10622 /* Accessing shadow register 0xe. */
10623 bnx2x_cl22_write(bp
, phy
,
10624 MDIO_REG_GPHY_SHADOW
,
10625 MDIO_REG_GPHY_SHADOW_LED_SEL2
);
10626 bnx2x_cl22_read(bp
, phy
,
10627 MDIO_REG_GPHY_SHADOW
,
10629 temp
&= ~(0xf << 4);
10630 temp
|= (0x6 << 4);
10631 bnx2x_cl22_write(bp
, phy
,
10632 MDIO_REG_GPHY_SHADOW
,
10633 MDIO_REG_GPHY_SHADOW_WR_ENA
| temp
);
10634 /* Configure INTR based on link status change. */
10635 bnx2x_cl22_write(bp
, phy
,
10636 MDIO_REG_INTR_MASK
,
10637 ~MDIO_REG_INTR_MASK_LINK_STATUS
);
10642 static int bnx2x_54618se_config_init(struct bnx2x_phy
*phy
,
10643 struct link_params
*params
,
10644 struct link_vars
*vars
)
10646 struct bnx2x
*bp
= params
->bp
;
10648 u16 autoneg_val
, an_1000_val
, an_10_100_val
, fc_val
, temp
;
10651 DP(NETIF_MSG_LINK
, "54618SE cfg init\n");
10652 usleep_range(1000, 2000);
10654 /* This works with E3 only, no need to check the chip
10655 * before determining the port.
10657 port
= params
->port
;
10659 cfg_pin
= (REG_RD(bp
, params
->shmem_base
+
10660 offsetof(struct shmem_region
,
10661 dev_info
.port_hw_config
[port
].e3_cmn_pin_cfg
)) &
10662 PORT_HW_CFG_E3_PHY_RESET_MASK
) >>
10663 PORT_HW_CFG_E3_PHY_RESET_SHIFT
;
10665 /* Drive pin high to bring the GPHY out of reset. */
10666 bnx2x_set_cfg_pin(bp
, cfg_pin
, 1);
10668 /* wait for GPHY to reset */
10672 bnx2x_cl22_write(bp
, phy
,
10673 MDIO_PMA_REG_CTRL
, 0x8000);
10674 bnx2x_wait_reset_complete(bp
, phy
, params
);
10676 /* Wait for GPHY to reset */
10680 bnx2x_54618se_specific_func(phy
, params
, PHY_INIT
);
10681 /* Flip the signal detect polarity (set 0x1c.0x1e[8]). */
10682 bnx2x_cl22_write(bp
, phy
,
10683 MDIO_REG_GPHY_SHADOW
,
10684 MDIO_REG_GPHY_SHADOW_AUTO_DET_MED
);
10685 bnx2x_cl22_read(bp
, phy
,
10686 MDIO_REG_GPHY_SHADOW
,
10688 temp
|= MDIO_REG_GPHY_SHADOW_INVERT_FIB_SD
;
10689 bnx2x_cl22_write(bp
, phy
,
10690 MDIO_REG_GPHY_SHADOW
,
10691 MDIO_REG_GPHY_SHADOW_WR_ENA
| temp
);
10694 /* Please refer to Table 28B-3 of 802.3ab-1999 spec. */
10695 bnx2x_calc_ieee_aneg_adv(phy
, params
, &vars
->ieee_fc
);
10697 if ((vars
->ieee_fc
& MDIO_COMBO_IEEE0_AUTO_NEG_ADV_PAUSE_ASYMMETRIC
) ==
10698 MDIO_COMBO_IEEE0_AUTO_NEG_ADV_PAUSE_ASYMMETRIC
)
10699 fc_val
|= MDIO_AN_REG_ADV_PAUSE_ASYMMETRIC
;
10701 if ((vars
->ieee_fc
& MDIO_COMBO_IEEE0_AUTO_NEG_ADV_PAUSE_BOTH
) ==
10702 MDIO_COMBO_IEEE0_AUTO_NEG_ADV_PAUSE_BOTH
)
10703 fc_val
|= MDIO_AN_REG_ADV_PAUSE_PAUSE
;
10705 /* Read all advertisement */
10706 bnx2x_cl22_read(bp
, phy
,
10710 bnx2x_cl22_read(bp
, phy
,
10714 bnx2x_cl22_read(bp
, phy
,
10718 /* Disable forced speed */
10719 autoneg_val
&= ~((1<<6) | (1<<8) | (1<<9) | (1<<12) | (1<<13));
10720 an_10_100_val
&= ~((1<<5) | (1<<6) | (1<<7) | (1<<8) | (1<<10) |
10723 if (((phy
->req_line_speed
== SPEED_AUTO_NEG
) &&
10724 (phy
->speed_cap_mask
&
10725 PORT_HW_CFG_SPEED_CAPABILITY_D0_1G
)) ||
10726 (phy
->req_line_speed
== SPEED_1000
)) {
10727 an_1000_val
|= (1<<8);
10728 autoneg_val
|= (1<<9 | 1<<12);
10729 if (phy
->req_duplex
== DUPLEX_FULL
)
10730 an_1000_val
|= (1<<9);
10731 DP(NETIF_MSG_LINK
, "Advertising 1G\n");
10733 an_1000_val
&= ~((1<<8) | (1<<9));
10735 bnx2x_cl22_write(bp
, phy
,
10738 bnx2x_cl22_read(bp
, phy
,
10742 /* Set 100 speed advertisement */
10743 if (((phy
->req_line_speed
== SPEED_AUTO_NEG
) &&
10744 (phy
->speed_cap_mask
&
10745 (PORT_HW_CFG_SPEED_CAPABILITY_D0_100M_FULL
|
10746 PORT_HW_CFG_SPEED_CAPABILITY_D0_100M_HALF
)))) {
10747 an_10_100_val
|= (1<<7);
10748 /* Enable autoneg and restart autoneg for legacy speeds */
10749 autoneg_val
|= (1<<9 | 1<<12);
10751 if (phy
->req_duplex
== DUPLEX_FULL
)
10752 an_10_100_val
|= (1<<8);
10753 DP(NETIF_MSG_LINK
, "Advertising 100M\n");
10756 /* Set 10 speed advertisement */
10757 if (((phy
->req_line_speed
== SPEED_AUTO_NEG
) &&
10758 (phy
->speed_cap_mask
&
10759 (PORT_HW_CFG_SPEED_CAPABILITY_D0_10M_FULL
|
10760 PORT_HW_CFG_SPEED_CAPABILITY_D0_10M_HALF
)))) {
10761 an_10_100_val
|= (1<<5);
10762 autoneg_val
|= (1<<9 | 1<<12);
10763 if (phy
->req_duplex
== DUPLEX_FULL
)
10764 an_10_100_val
|= (1<<6);
10765 DP(NETIF_MSG_LINK
, "Advertising 10M\n");
10768 /* Only 10/100 are allowed to work in FORCE mode */
10769 if (phy
->req_line_speed
== SPEED_100
) {
10770 autoneg_val
|= (1<<13);
10771 /* Enabled AUTO-MDIX when autoneg is disabled */
10772 bnx2x_cl22_write(bp
, phy
,
10774 (1<<15 | 1<<9 | 7<<0));
10775 DP(NETIF_MSG_LINK
, "Setting 100M force\n");
10777 if (phy
->req_line_speed
== SPEED_10
) {
10778 /* Enabled AUTO-MDIX when autoneg is disabled */
10779 bnx2x_cl22_write(bp
, phy
,
10781 (1<<15 | 1<<9 | 7<<0));
10782 DP(NETIF_MSG_LINK
, "Setting 10M force\n");
10785 if ((phy
->flags
& FLAGS_EEE
) && bnx2x_eee_has_cap(params
)) {
10788 bnx2x_cl22_write(bp
, phy
, MDIO_REG_GPHY_EXP_ACCESS
,
10789 MDIO_REG_GPHY_EXP_ACCESS_TOP
|
10790 MDIO_REG_GPHY_EXP_TOP_2K_BUF
);
10791 bnx2x_cl22_read(bp
, phy
, MDIO_REG_GPHY_EXP_ACCESS_GATE
, &temp
);
10793 bnx2x_cl22_write(bp
, phy
, MDIO_REG_GPHY_EXP_ACCESS_GATE
, temp
);
10795 rc
= bnx2x_eee_initial_config(params
, vars
, SHMEM_EEE_1G_ADV
);
10797 DP(NETIF_MSG_LINK
, "Failed to configure EEE timers\n");
10798 bnx2x_eee_disable(phy
, params
, vars
);
10799 } else if ((params
->eee_mode
& EEE_MODE_ADV_LPI
) &&
10800 (phy
->req_duplex
== DUPLEX_FULL
) &&
10801 (bnx2x_eee_calc_timer(params
) ||
10802 !(params
->eee_mode
& EEE_MODE_ENABLE_LPI
))) {
10803 /* Need to advertise EEE only when requested,
10804 * and either no LPI assertion was requested,
10805 * or it was requested and a valid timer was set.
10806 * Also notice full duplex is required for EEE.
10808 bnx2x_eee_advertise(phy
, params
, vars
,
10811 DP(NETIF_MSG_LINK
, "Don't Advertise 1GBase-T EEE\n");
10812 bnx2x_eee_disable(phy
, params
, vars
);
10815 vars
->eee_status
&= ~SHMEM_EEE_1G_ADV
<<
10816 SHMEM_EEE_SUPPORTED_SHIFT
;
10818 if (phy
->flags
& FLAGS_EEE
) {
10819 /* Handle legacy auto-grEEEn */
10820 if (params
->feature_config_flags
&
10821 FEATURE_CONFIG_AUTOGREEEN_ENABLED
) {
10823 DP(NETIF_MSG_LINK
, "Enabling Auto-GrEEEn\n");
10826 DP(NETIF_MSG_LINK
, "Don't Adv. EEE\n");
10828 bnx2x_cl45_write(bp
, phy
, MDIO_AN_DEVAD
,
10829 MDIO_AN_REG_EEE_ADV
, temp
);
10833 bnx2x_cl22_write(bp
, phy
,
10835 an_10_100_val
| fc_val
);
10837 if (phy
->req_duplex
== DUPLEX_FULL
)
10838 autoneg_val
|= (1<<8);
10840 bnx2x_cl22_write(bp
, phy
,
10841 MDIO_PMA_REG_CTRL
, autoneg_val
);
10847 static void bnx2x_5461x_set_link_led(struct bnx2x_phy
*phy
,
10848 struct link_params
*params
, u8 mode
)
10850 struct bnx2x
*bp
= params
->bp
;
10853 bnx2x_cl22_write(bp
, phy
,
10854 MDIO_REG_GPHY_SHADOW
,
10855 MDIO_REG_GPHY_SHADOW_LED_SEL1
);
10856 bnx2x_cl22_read(bp
, phy
,
10857 MDIO_REG_GPHY_SHADOW
,
10861 DP(NETIF_MSG_LINK
, "54618x set link led (mode=%x)\n", mode
);
10863 case LED_MODE_FRONT_PANEL_OFF
:
10867 case LED_MODE_OPER
:
10876 bnx2x_cl22_write(bp
, phy
,
10877 MDIO_REG_GPHY_SHADOW
,
10878 MDIO_REG_GPHY_SHADOW_WR_ENA
| temp
);
10883 static void bnx2x_54618se_link_reset(struct bnx2x_phy
*phy
,
10884 struct link_params
*params
)
10886 struct bnx2x
*bp
= params
->bp
;
10890 /* In case of no EPIO routed to reset the GPHY, put it
10891 * in low power mode.
10893 bnx2x_cl22_write(bp
, phy
, MDIO_PMA_REG_CTRL
, 0x800);
10894 /* This works with E3 only, no need to check the chip
10895 * before determining the port.
10897 port
= params
->port
;
10898 cfg_pin
= (REG_RD(bp
, params
->shmem_base
+
10899 offsetof(struct shmem_region
,
10900 dev_info
.port_hw_config
[port
].e3_cmn_pin_cfg
)) &
10901 PORT_HW_CFG_E3_PHY_RESET_MASK
) >>
10902 PORT_HW_CFG_E3_PHY_RESET_SHIFT
;
10904 /* Drive pin low to put GPHY in reset. */
10905 bnx2x_set_cfg_pin(bp
, cfg_pin
, 0);
10908 static u8
bnx2x_54618se_read_status(struct bnx2x_phy
*phy
,
10909 struct link_params
*params
,
10910 struct link_vars
*vars
)
10912 struct bnx2x
*bp
= params
->bp
;
10915 u16 legacy_status
, legacy_speed
;
10917 /* Get speed operation status */
10918 bnx2x_cl22_read(bp
, phy
,
10919 MDIO_REG_GPHY_AUX_STATUS
,
10921 DP(NETIF_MSG_LINK
, "54618SE read_status: 0x%x\n", legacy_status
);
10923 /* Read status to clear the PHY interrupt. */
10924 bnx2x_cl22_read(bp
, phy
,
10925 MDIO_REG_INTR_STATUS
,
10928 link_up
= ((legacy_status
& (1<<2)) == (1<<2));
10931 legacy_speed
= (legacy_status
& (7<<8));
10932 if (legacy_speed
== (7<<8)) {
10933 vars
->line_speed
= SPEED_1000
;
10934 vars
->duplex
= DUPLEX_FULL
;
10935 } else if (legacy_speed
== (6<<8)) {
10936 vars
->line_speed
= SPEED_1000
;
10937 vars
->duplex
= DUPLEX_HALF
;
10938 } else if (legacy_speed
== (5<<8)) {
10939 vars
->line_speed
= SPEED_100
;
10940 vars
->duplex
= DUPLEX_FULL
;
10942 /* Omitting 100Base-T4 for now */
10943 else if (legacy_speed
== (3<<8)) {
10944 vars
->line_speed
= SPEED_100
;
10945 vars
->duplex
= DUPLEX_HALF
;
10946 } else if (legacy_speed
== (2<<8)) {
10947 vars
->line_speed
= SPEED_10
;
10948 vars
->duplex
= DUPLEX_FULL
;
10949 } else if (legacy_speed
== (1<<8)) {
10950 vars
->line_speed
= SPEED_10
;
10951 vars
->duplex
= DUPLEX_HALF
;
10952 } else /* Should not happen */
10953 vars
->line_speed
= 0;
10956 "Link is up in %dMbps, is_duplex_full= %d\n",
10958 (vars
->duplex
== DUPLEX_FULL
));
10960 /* Check legacy speed AN resolution */
10961 bnx2x_cl22_read(bp
, phy
,
10965 vars
->link_status
|=
10966 LINK_STATUS_AUTO_NEGOTIATE_COMPLETE
;
10967 bnx2x_cl22_read(bp
, phy
,
10970 if ((val
& (1<<0)) == 0)
10971 vars
->link_status
|=
10972 LINK_STATUS_PARALLEL_DETECTION_USED
;
10974 DP(NETIF_MSG_LINK
, "BCM54618SE: link speed is %d\n",
10977 bnx2x_ext_phy_resolve_fc(phy
, params
, vars
);
10979 if (vars
->link_status
& LINK_STATUS_AUTO_NEGOTIATE_COMPLETE
) {
10980 /* Report LP advertised speeds */
10981 bnx2x_cl22_read(bp
, phy
, 0x5, &val
);
10984 vars
->link_status
|=
10985 LINK_STATUS_LINK_PARTNER_10THD_CAPABLE
;
10987 vars
->link_status
|=
10988 LINK_STATUS_LINK_PARTNER_10TFD_CAPABLE
;
10990 vars
->link_status
|=
10991 LINK_STATUS_LINK_PARTNER_100TXHD_CAPABLE
;
10993 vars
->link_status
|=
10994 LINK_STATUS_LINK_PARTNER_100TXFD_CAPABLE
;
10996 vars
->link_status
|=
10997 LINK_STATUS_LINK_PARTNER_100T4_CAPABLE
;
10999 bnx2x_cl22_read(bp
, phy
, 0xa, &val
);
11001 vars
->link_status
|=
11002 LINK_STATUS_LINK_PARTNER_1000THD_CAPABLE
;
11004 vars
->link_status
|=
11005 LINK_STATUS_LINK_PARTNER_1000TFD_CAPABLE
;
11007 if ((phy
->flags
& FLAGS_EEE
) &&
11008 bnx2x_eee_has_cap(params
))
11009 bnx2x_eee_an_resolve(phy
, params
, vars
);
11015 static void bnx2x_54618se_config_loopback(struct bnx2x_phy
*phy
,
11016 struct link_params
*params
)
11018 struct bnx2x
*bp
= params
->bp
;
11020 u32 umac_base
= params
->port
? GRCBASE_UMAC1
: GRCBASE_UMAC0
;
11022 DP(NETIF_MSG_LINK
, "2PMA/PMD ext_phy_loopback: 54618se\n");
11024 /* Enable master/slave manual mmode and set to master */
11025 /* mii write 9 [bits set 11 12] */
11026 bnx2x_cl22_write(bp
, phy
, 0x09, 3<<11);
11028 /* forced 1G and disable autoneg */
11029 /* set val [mii read 0] */
11030 /* set val [expr $val & [bits clear 6 12 13]] */
11031 /* set val [expr $val | [bits set 6 8]] */
11032 /* mii write 0 $val */
11033 bnx2x_cl22_read(bp
, phy
, 0x00, &val
);
11034 val
&= ~((1<<6) | (1<<12) | (1<<13));
11035 val
|= (1<<6) | (1<<8);
11036 bnx2x_cl22_write(bp
, phy
, 0x00, val
);
11038 /* Set external loopback and Tx using 6dB coding */
11039 /* mii write 0x18 7 */
11040 /* set val [mii read 0x18] */
11041 /* mii write 0x18 [expr $val | [bits set 10 15]] */
11042 bnx2x_cl22_write(bp
, phy
, 0x18, 7);
11043 bnx2x_cl22_read(bp
, phy
, 0x18, &val
);
11044 bnx2x_cl22_write(bp
, phy
, 0x18, val
| (1<<10) | (1<<15));
11046 /* This register opens the gate for the UMAC despite its name */
11047 REG_WR(bp
, NIG_REG_EGRESS_EMAC0_PORT
+ params
->port
*4, 1);
11049 /* Maximum Frame Length (RW). Defines a 14-Bit maximum frame
11050 * length used by the MAC receive logic to check frames.
11052 REG_WR(bp
, umac_base
+ UMAC_REG_MAXFR
, 0x2710);
11055 /******************************************************************/
11056 /* SFX7101 PHY SECTION */
11057 /******************************************************************/
11058 static void bnx2x_7101_config_loopback(struct bnx2x_phy
*phy
,
11059 struct link_params
*params
)
11061 struct bnx2x
*bp
= params
->bp
;
11062 /* SFX7101_XGXS_TEST1 */
11063 bnx2x_cl45_write(bp
, phy
,
11064 MDIO_XS_DEVAD
, MDIO_XS_SFX7101_XGXS_TEST1
, 0x100);
11067 static int bnx2x_7101_config_init(struct bnx2x_phy
*phy
,
11068 struct link_params
*params
,
11069 struct link_vars
*vars
)
11071 u16 fw_ver1
, fw_ver2
, val
;
11072 struct bnx2x
*bp
= params
->bp
;
11073 DP(NETIF_MSG_LINK
, "Setting the SFX7101 LASI indication\n");
11075 /* Restore normal power mode*/
11076 bnx2x_set_gpio(bp
, MISC_REGISTERS_GPIO_2
,
11077 MISC_REGISTERS_GPIO_OUTPUT_HIGH
, params
->port
);
11079 bnx2x_ext_phy_hw_reset(bp
, params
->port
);
11080 bnx2x_wait_reset_complete(bp
, phy
, params
);
11082 bnx2x_cl45_write(bp
, phy
,
11083 MDIO_PMA_DEVAD
, MDIO_PMA_LASI_CTRL
, 0x1);
11084 DP(NETIF_MSG_LINK
, "Setting the SFX7101 LED to blink on traffic\n");
11085 bnx2x_cl45_write(bp
, phy
,
11086 MDIO_PMA_DEVAD
, MDIO_PMA_REG_7107_LED_CNTL
, (1<<3));
11088 bnx2x_ext_phy_set_pause(params
, phy
, vars
);
11089 /* Restart autoneg */
11090 bnx2x_cl45_read(bp
, phy
,
11091 MDIO_AN_DEVAD
, MDIO_AN_REG_CTRL
, &val
);
11093 bnx2x_cl45_write(bp
, phy
,
11094 MDIO_AN_DEVAD
, MDIO_AN_REG_CTRL
, val
);
11096 /* Save spirom version */
11097 bnx2x_cl45_read(bp
, phy
,
11098 MDIO_PMA_DEVAD
, MDIO_PMA_REG_7101_VER1
, &fw_ver1
);
11100 bnx2x_cl45_read(bp
, phy
,
11101 MDIO_PMA_DEVAD
, MDIO_PMA_REG_7101_VER2
, &fw_ver2
);
11102 bnx2x_save_spirom_version(bp
, params
->port
,
11103 (u32
)(fw_ver1
<<16 | fw_ver2
), phy
->ver_addr
);
11107 static u8
bnx2x_7101_read_status(struct bnx2x_phy
*phy
,
11108 struct link_params
*params
,
11109 struct link_vars
*vars
)
11111 struct bnx2x
*bp
= params
->bp
;
11114 bnx2x_cl45_read(bp
, phy
,
11115 MDIO_PMA_DEVAD
, MDIO_PMA_LASI_STAT
, &val2
);
11116 bnx2x_cl45_read(bp
, phy
,
11117 MDIO_PMA_DEVAD
, MDIO_PMA_LASI_STAT
, &val1
);
11118 DP(NETIF_MSG_LINK
, "10G-base-T LASI status 0x%x->0x%x\n",
11120 bnx2x_cl45_read(bp
, phy
,
11121 MDIO_PMA_DEVAD
, MDIO_PMA_REG_STATUS
, &val2
);
11122 bnx2x_cl45_read(bp
, phy
,
11123 MDIO_PMA_DEVAD
, MDIO_PMA_REG_STATUS
, &val1
);
11124 DP(NETIF_MSG_LINK
, "10G-base-T PMA status 0x%x->0x%x\n",
11126 link_up
= ((val1
& 4) == 4);
11127 /* If link is up print the AN outcome of the SFX7101 PHY */
11129 bnx2x_cl45_read(bp
, phy
,
11130 MDIO_AN_DEVAD
, MDIO_AN_REG_MASTER_STATUS
,
11132 vars
->line_speed
= SPEED_10000
;
11133 vars
->duplex
= DUPLEX_FULL
;
11134 DP(NETIF_MSG_LINK
, "SFX7101 AN status 0x%x->Master=%x\n",
11135 val2
, (val2
& (1<<14)));
11136 bnx2x_ext_phy_10G_an_resolve(bp
, phy
, vars
);
11137 bnx2x_ext_phy_resolve_fc(phy
, params
, vars
);
11139 /* Read LP advertised speeds */
11140 if (val2
& (1<<11))
11141 vars
->link_status
|=
11142 LINK_STATUS_LINK_PARTNER_10GXFD_CAPABLE
;
11147 static int bnx2x_7101_format_ver(u32 spirom_ver
, u8
*str
, u16
*len
)
11151 str
[0] = (spirom_ver
& 0xFF);
11152 str
[1] = (spirom_ver
& 0xFF00) >> 8;
11153 str
[2] = (spirom_ver
& 0xFF0000) >> 16;
11154 str
[3] = (spirom_ver
& 0xFF000000) >> 24;
11160 void bnx2x_sfx7101_sp_sw_reset(struct bnx2x
*bp
, struct bnx2x_phy
*phy
)
11164 bnx2x_cl45_read(bp
, phy
,
11166 MDIO_PMA_REG_7101_RESET
, &val
);
11168 for (cnt
= 0; cnt
< 10; cnt
++) {
11170 /* Writes a self-clearing reset */
11171 bnx2x_cl45_write(bp
, phy
,
11173 MDIO_PMA_REG_7101_RESET
,
11175 /* Wait for clear */
11176 bnx2x_cl45_read(bp
, phy
,
11178 MDIO_PMA_REG_7101_RESET
, &val
);
11180 if ((val
& (1<<15)) == 0)
11185 static void bnx2x_7101_hw_reset(struct bnx2x_phy
*phy
,
11186 struct link_params
*params
) {
11187 /* Low power mode is controlled by GPIO 2 */
11188 bnx2x_set_gpio(params
->bp
, MISC_REGISTERS_GPIO_2
,
11189 MISC_REGISTERS_GPIO_OUTPUT_LOW
, params
->port
);
11190 /* The PHY reset is controlled by GPIO 1 */
11191 bnx2x_set_gpio(params
->bp
, MISC_REGISTERS_GPIO_1
,
11192 MISC_REGISTERS_GPIO_OUTPUT_LOW
, params
->port
);
11195 static void bnx2x_7101_set_link_led(struct bnx2x_phy
*phy
,
11196 struct link_params
*params
, u8 mode
)
11199 struct bnx2x
*bp
= params
->bp
;
11201 case LED_MODE_FRONT_PANEL_OFF
:
11208 case LED_MODE_OPER
:
11212 bnx2x_cl45_write(bp
, phy
,
11214 MDIO_PMA_REG_7107_LINK_LED_CNTL
,
11218 /******************************************************************/
11219 /* STATIC PHY DECLARATION */
11220 /******************************************************************/
11222 static const struct bnx2x_phy phy_null
= {
11223 .type
= PORT_HW_CFG_XGXS_EXT_PHY_TYPE_NOT_CONN
,
11226 .flags
= FLAGS_INIT_XGXS_FIRST
,
11227 .rx_preemphasis
= {0xffff, 0xffff, 0xffff, 0xffff},
11228 .tx_preemphasis
= {0xffff, 0xffff, 0xffff, 0xffff},
11231 .media_type
= ETH_PHY_NOT_PRESENT
,
11233 .req_flow_ctrl
= 0,
11234 .req_line_speed
= 0,
11235 .speed_cap_mask
= 0,
11238 .config_init
= (config_init_t
)NULL
,
11239 .read_status
= (read_status_t
)NULL
,
11240 .link_reset
= (link_reset_t
)NULL
,
11241 .config_loopback
= (config_loopback_t
)NULL
,
11242 .format_fw_ver
= (format_fw_ver_t
)NULL
,
11243 .hw_reset
= (hw_reset_t
)NULL
,
11244 .set_link_led
= (set_link_led_t
)NULL
,
11245 .phy_specific_func
= (phy_specific_func_t
)NULL
11248 static const struct bnx2x_phy phy_serdes
= {
11249 .type
= PORT_HW_CFG_SERDES_EXT_PHY_TYPE_DIRECT
,
11253 .rx_preemphasis
= {0xffff, 0xffff, 0xffff, 0xffff},
11254 .tx_preemphasis
= {0xffff, 0xffff, 0xffff, 0xffff},
11256 .supported
= (SUPPORTED_10baseT_Half
|
11257 SUPPORTED_10baseT_Full
|
11258 SUPPORTED_100baseT_Half
|
11259 SUPPORTED_100baseT_Full
|
11260 SUPPORTED_1000baseT_Full
|
11261 SUPPORTED_2500baseX_Full
|
11263 SUPPORTED_Autoneg
|
11265 SUPPORTED_Asym_Pause
),
11266 .media_type
= ETH_PHY_BASE_T
,
11268 .req_flow_ctrl
= 0,
11269 .req_line_speed
= 0,
11270 .speed_cap_mask
= 0,
11273 .config_init
= (config_init_t
)bnx2x_xgxs_config_init
,
11274 .read_status
= (read_status_t
)bnx2x_link_settings_status
,
11275 .link_reset
= (link_reset_t
)bnx2x_int_link_reset
,
11276 .config_loopback
= (config_loopback_t
)NULL
,
11277 .format_fw_ver
= (format_fw_ver_t
)NULL
,
11278 .hw_reset
= (hw_reset_t
)NULL
,
11279 .set_link_led
= (set_link_led_t
)NULL
,
11280 .phy_specific_func
= (phy_specific_func_t
)NULL
11283 static const struct bnx2x_phy phy_xgxs
= {
11284 .type
= PORT_HW_CFG_XGXS_EXT_PHY_TYPE_DIRECT
,
11288 .rx_preemphasis
= {0xffff, 0xffff, 0xffff, 0xffff},
11289 .tx_preemphasis
= {0xffff, 0xffff, 0xffff, 0xffff},
11291 .supported
= (SUPPORTED_10baseT_Half
|
11292 SUPPORTED_10baseT_Full
|
11293 SUPPORTED_100baseT_Half
|
11294 SUPPORTED_100baseT_Full
|
11295 SUPPORTED_1000baseT_Full
|
11296 SUPPORTED_2500baseX_Full
|
11297 SUPPORTED_10000baseT_Full
|
11299 SUPPORTED_Autoneg
|
11301 SUPPORTED_Asym_Pause
),
11302 .media_type
= ETH_PHY_CX4
,
11304 .req_flow_ctrl
= 0,
11305 .req_line_speed
= 0,
11306 .speed_cap_mask
= 0,
11309 .config_init
= (config_init_t
)bnx2x_xgxs_config_init
,
11310 .read_status
= (read_status_t
)bnx2x_link_settings_status
,
11311 .link_reset
= (link_reset_t
)bnx2x_int_link_reset
,
11312 .config_loopback
= (config_loopback_t
)bnx2x_set_xgxs_loopback
,
11313 .format_fw_ver
= (format_fw_ver_t
)NULL
,
11314 .hw_reset
= (hw_reset_t
)NULL
,
11315 .set_link_led
= (set_link_led_t
)NULL
,
11316 .phy_specific_func
= (phy_specific_func_t
)bnx2x_xgxs_specific_func
11318 static const struct bnx2x_phy phy_warpcore
= {
11319 .type
= PORT_HW_CFG_XGXS_EXT_PHY_TYPE_DIRECT
,
11322 .flags
= FLAGS_TX_ERROR_CHECK
,
11323 .rx_preemphasis
= {0xffff, 0xffff, 0xffff, 0xffff},
11324 .tx_preemphasis
= {0xffff, 0xffff, 0xffff, 0xffff},
11326 .supported
= (SUPPORTED_10baseT_Half
|
11327 SUPPORTED_10baseT_Full
|
11328 SUPPORTED_100baseT_Half
|
11329 SUPPORTED_100baseT_Full
|
11330 SUPPORTED_1000baseT_Full
|
11331 SUPPORTED_10000baseT_Full
|
11332 SUPPORTED_20000baseKR2_Full
|
11333 SUPPORTED_20000baseMLD2_Full
|
11335 SUPPORTED_Autoneg
|
11337 SUPPORTED_Asym_Pause
),
11338 .media_type
= ETH_PHY_UNSPECIFIED
,
11340 .req_flow_ctrl
= 0,
11341 .req_line_speed
= 0,
11342 .speed_cap_mask
= 0,
11343 /* req_duplex = */0,
11345 .config_init
= (config_init_t
)bnx2x_warpcore_config_init
,
11346 .read_status
= (read_status_t
)bnx2x_warpcore_read_status
,
11347 .link_reset
= (link_reset_t
)bnx2x_warpcore_link_reset
,
11348 .config_loopback
= (config_loopback_t
)bnx2x_set_warpcore_loopback
,
11349 .format_fw_ver
= (format_fw_ver_t
)NULL
,
11350 .hw_reset
= (hw_reset_t
)bnx2x_warpcore_hw_reset
,
11351 .set_link_led
= (set_link_led_t
)NULL
,
11352 .phy_specific_func
= (phy_specific_func_t
)NULL
11356 static const struct bnx2x_phy phy_7101
= {
11357 .type
= PORT_HW_CFG_XGXS_EXT_PHY_TYPE_SFX7101
,
11360 .flags
= FLAGS_FAN_FAILURE_DET_REQ
,
11361 .rx_preemphasis
= {0xffff, 0xffff, 0xffff, 0xffff},
11362 .tx_preemphasis
= {0xffff, 0xffff, 0xffff, 0xffff},
11364 .supported
= (SUPPORTED_10000baseT_Full
|
11366 SUPPORTED_Autoneg
|
11368 SUPPORTED_Asym_Pause
),
11369 .media_type
= ETH_PHY_BASE_T
,
11371 .req_flow_ctrl
= 0,
11372 .req_line_speed
= 0,
11373 .speed_cap_mask
= 0,
11376 .config_init
= (config_init_t
)bnx2x_7101_config_init
,
11377 .read_status
= (read_status_t
)bnx2x_7101_read_status
,
11378 .link_reset
= (link_reset_t
)bnx2x_common_ext_link_reset
,
11379 .config_loopback
= (config_loopback_t
)bnx2x_7101_config_loopback
,
11380 .format_fw_ver
= (format_fw_ver_t
)bnx2x_7101_format_ver
,
11381 .hw_reset
= (hw_reset_t
)bnx2x_7101_hw_reset
,
11382 .set_link_led
= (set_link_led_t
)bnx2x_7101_set_link_led
,
11383 .phy_specific_func
= (phy_specific_func_t
)NULL
11385 static const struct bnx2x_phy phy_8073
= {
11386 .type
= PORT_HW_CFG_XGXS_EXT_PHY_TYPE_BCM8073
,
11390 .rx_preemphasis
= {0xffff, 0xffff, 0xffff, 0xffff},
11391 .tx_preemphasis
= {0xffff, 0xffff, 0xffff, 0xffff},
11393 .supported
= (SUPPORTED_10000baseT_Full
|
11394 SUPPORTED_2500baseX_Full
|
11395 SUPPORTED_1000baseT_Full
|
11397 SUPPORTED_Autoneg
|
11399 SUPPORTED_Asym_Pause
),
11400 .media_type
= ETH_PHY_KR
,
11402 .req_flow_ctrl
= 0,
11403 .req_line_speed
= 0,
11404 .speed_cap_mask
= 0,
11407 .config_init
= (config_init_t
)bnx2x_8073_config_init
,
11408 .read_status
= (read_status_t
)bnx2x_8073_read_status
,
11409 .link_reset
= (link_reset_t
)bnx2x_8073_link_reset
,
11410 .config_loopback
= (config_loopback_t
)NULL
,
11411 .format_fw_ver
= (format_fw_ver_t
)bnx2x_format_ver
,
11412 .hw_reset
= (hw_reset_t
)NULL
,
11413 .set_link_led
= (set_link_led_t
)NULL
,
11414 .phy_specific_func
= (phy_specific_func_t
)bnx2x_8073_specific_func
11416 static const struct bnx2x_phy phy_8705
= {
11417 .type
= PORT_HW_CFG_XGXS_EXT_PHY_TYPE_BCM8705
,
11420 .flags
= FLAGS_INIT_XGXS_FIRST
,
11421 .rx_preemphasis
= {0xffff, 0xffff, 0xffff, 0xffff},
11422 .tx_preemphasis
= {0xffff, 0xffff, 0xffff, 0xffff},
11424 .supported
= (SUPPORTED_10000baseT_Full
|
11427 SUPPORTED_Asym_Pause
),
11428 .media_type
= ETH_PHY_XFP_FIBER
,
11430 .req_flow_ctrl
= 0,
11431 .req_line_speed
= 0,
11432 .speed_cap_mask
= 0,
11435 .config_init
= (config_init_t
)bnx2x_8705_config_init
,
11436 .read_status
= (read_status_t
)bnx2x_8705_read_status
,
11437 .link_reset
= (link_reset_t
)bnx2x_common_ext_link_reset
,
11438 .config_loopback
= (config_loopback_t
)NULL
,
11439 .format_fw_ver
= (format_fw_ver_t
)bnx2x_null_format_ver
,
11440 .hw_reset
= (hw_reset_t
)NULL
,
11441 .set_link_led
= (set_link_led_t
)NULL
,
11442 .phy_specific_func
= (phy_specific_func_t
)NULL
11444 static const struct bnx2x_phy phy_8706
= {
11445 .type
= PORT_HW_CFG_XGXS_EXT_PHY_TYPE_BCM8706
,
11448 .flags
= FLAGS_INIT_XGXS_FIRST
,
11449 .rx_preemphasis
= {0xffff, 0xffff, 0xffff, 0xffff},
11450 .tx_preemphasis
= {0xffff, 0xffff, 0xffff, 0xffff},
11452 .supported
= (SUPPORTED_10000baseT_Full
|
11453 SUPPORTED_1000baseT_Full
|
11456 SUPPORTED_Asym_Pause
),
11457 .media_type
= ETH_PHY_SFPP_10G_FIBER
,
11459 .req_flow_ctrl
= 0,
11460 .req_line_speed
= 0,
11461 .speed_cap_mask
= 0,
11464 .config_init
= (config_init_t
)bnx2x_8706_config_init
,
11465 .read_status
= (read_status_t
)bnx2x_8706_read_status
,
11466 .link_reset
= (link_reset_t
)bnx2x_common_ext_link_reset
,
11467 .config_loopback
= (config_loopback_t
)NULL
,
11468 .format_fw_ver
= (format_fw_ver_t
)bnx2x_format_ver
,
11469 .hw_reset
= (hw_reset_t
)NULL
,
11470 .set_link_led
= (set_link_led_t
)NULL
,
11471 .phy_specific_func
= (phy_specific_func_t
)NULL
11474 static const struct bnx2x_phy phy_8726
= {
11475 .type
= PORT_HW_CFG_XGXS_EXT_PHY_TYPE_BCM8726
,
11478 .flags
= (FLAGS_INIT_XGXS_FIRST
|
11479 FLAGS_TX_ERROR_CHECK
),
11480 .rx_preemphasis
= {0xffff, 0xffff, 0xffff, 0xffff},
11481 .tx_preemphasis
= {0xffff, 0xffff, 0xffff, 0xffff},
11483 .supported
= (SUPPORTED_10000baseT_Full
|
11484 SUPPORTED_1000baseT_Full
|
11485 SUPPORTED_Autoneg
|
11488 SUPPORTED_Asym_Pause
),
11489 .media_type
= ETH_PHY_NOT_PRESENT
,
11491 .req_flow_ctrl
= 0,
11492 .req_line_speed
= 0,
11493 .speed_cap_mask
= 0,
11496 .config_init
= (config_init_t
)bnx2x_8726_config_init
,
11497 .read_status
= (read_status_t
)bnx2x_8726_read_status
,
11498 .link_reset
= (link_reset_t
)bnx2x_8726_link_reset
,
11499 .config_loopback
= (config_loopback_t
)bnx2x_8726_config_loopback
,
11500 .format_fw_ver
= (format_fw_ver_t
)bnx2x_format_ver
,
11501 .hw_reset
= (hw_reset_t
)NULL
,
11502 .set_link_led
= (set_link_led_t
)NULL
,
11503 .phy_specific_func
= (phy_specific_func_t
)NULL
11506 static const struct bnx2x_phy phy_8727
= {
11507 .type
= PORT_HW_CFG_XGXS_EXT_PHY_TYPE_BCM8727
,
11510 .flags
= (FLAGS_FAN_FAILURE_DET_REQ
|
11511 FLAGS_TX_ERROR_CHECK
),
11512 .rx_preemphasis
= {0xffff, 0xffff, 0xffff, 0xffff},
11513 .tx_preemphasis
= {0xffff, 0xffff, 0xffff, 0xffff},
11515 .supported
= (SUPPORTED_10000baseT_Full
|
11516 SUPPORTED_1000baseT_Full
|
11519 SUPPORTED_Asym_Pause
),
11520 .media_type
= ETH_PHY_NOT_PRESENT
,
11522 .req_flow_ctrl
= 0,
11523 .req_line_speed
= 0,
11524 .speed_cap_mask
= 0,
11527 .config_init
= (config_init_t
)bnx2x_8727_config_init
,
11528 .read_status
= (read_status_t
)bnx2x_8727_read_status
,
11529 .link_reset
= (link_reset_t
)bnx2x_8727_link_reset
,
11530 .config_loopback
= (config_loopback_t
)NULL
,
11531 .format_fw_ver
= (format_fw_ver_t
)bnx2x_format_ver
,
11532 .hw_reset
= (hw_reset_t
)bnx2x_8727_hw_reset
,
11533 .set_link_led
= (set_link_led_t
)bnx2x_8727_set_link_led
,
11534 .phy_specific_func
= (phy_specific_func_t
)bnx2x_8727_specific_func
11536 static const struct bnx2x_phy phy_8481
= {
11537 .type
= PORT_HW_CFG_XGXS_EXT_PHY_TYPE_BCM8481
,
11540 .flags
= FLAGS_FAN_FAILURE_DET_REQ
|
11541 FLAGS_REARM_LATCH_SIGNAL
,
11542 .rx_preemphasis
= {0xffff, 0xffff, 0xffff, 0xffff},
11543 .tx_preemphasis
= {0xffff, 0xffff, 0xffff, 0xffff},
11545 .supported
= (SUPPORTED_10baseT_Half
|
11546 SUPPORTED_10baseT_Full
|
11547 SUPPORTED_100baseT_Half
|
11548 SUPPORTED_100baseT_Full
|
11549 SUPPORTED_1000baseT_Full
|
11550 SUPPORTED_10000baseT_Full
|
11552 SUPPORTED_Autoneg
|
11554 SUPPORTED_Asym_Pause
),
11555 .media_type
= ETH_PHY_BASE_T
,
11557 .req_flow_ctrl
= 0,
11558 .req_line_speed
= 0,
11559 .speed_cap_mask
= 0,
11562 .config_init
= (config_init_t
)bnx2x_8481_config_init
,
11563 .read_status
= (read_status_t
)bnx2x_848xx_read_status
,
11564 .link_reset
= (link_reset_t
)bnx2x_8481_link_reset
,
11565 .config_loopback
= (config_loopback_t
)NULL
,
11566 .format_fw_ver
= (format_fw_ver_t
)bnx2x_848xx_format_ver
,
11567 .hw_reset
= (hw_reset_t
)bnx2x_8481_hw_reset
,
11568 .set_link_led
= (set_link_led_t
)bnx2x_848xx_set_link_led
,
11569 .phy_specific_func
= (phy_specific_func_t
)NULL
11572 static const struct bnx2x_phy phy_84823
= {
11573 .type
= PORT_HW_CFG_XGXS_EXT_PHY_TYPE_BCM84823
,
11576 .flags
= (FLAGS_FAN_FAILURE_DET_REQ
|
11577 FLAGS_REARM_LATCH_SIGNAL
|
11578 FLAGS_TX_ERROR_CHECK
),
11579 .rx_preemphasis
= {0xffff, 0xffff, 0xffff, 0xffff},
11580 .tx_preemphasis
= {0xffff, 0xffff, 0xffff, 0xffff},
11582 .supported
= (SUPPORTED_10baseT_Half
|
11583 SUPPORTED_10baseT_Full
|
11584 SUPPORTED_100baseT_Half
|
11585 SUPPORTED_100baseT_Full
|
11586 SUPPORTED_1000baseT_Full
|
11587 SUPPORTED_10000baseT_Full
|
11589 SUPPORTED_Autoneg
|
11591 SUPPORTED_Asym_Pause
),
11592 .media_type
= ETH_PHY_BASE_T
,
11594 .req_flow_ctrl
= 0,
11595 .req_line_speed
= 0,
11596 .speed_cap_mask
= 0,
11599 .config_init
= (config_init_t
)bnx2x_848x3_config_init
,
11600 .read_status
= (read_status_t
)bnx2x_848xx_read_status
,
11601 .link_reset
= (link_reset_t
)bnx2x_848x3_link_reset
,
11602 .config_loopback
= (config_loopback_t
)NULL
,
11603 .format_fw_ver
= (format_fw_ver_t
)bnx2x_848xx_format_ver
,
11604 .hw_reset
= (hw_reset_t
)NULL
,
11605 .set_link_led
= (set_link_led_t
)bnx2x_848xx_set_link_led
,
11606 .phy_specific_func
= (phy_specific_func_t
)bnx2x_848xx_specific_func
11609 static const struct bnx2x_phy phy_84833
= {
11610 .type
= PORT_HW_CFG_XGXS_EXT_PHY_TYPE_BCM84833
,
11613 .flags
= (FLAGS_FAN_FAILURE_DET_REQ
|
11614 FLAGS_REARM_LATCH_SIGNAL
|
11615 FLAGS_TX_ERROR_CHECK
),
11616 .rx_preemphasis
= {0xffff, 0xffff, 0xffff, 0xffff},
11617 .tx_preemphasis
= {0xffff, 0xffff, 0xffff, 0xffff},
11619 .supported
= (SUPPORTED_100baseT_Half
|
11620 SUPPORTED_100baseT_Full
|
11621 SUPPORTED_1000baseT_Full
|
11622 SUPPORTED_10000baseT_Full
|
11624 SUPPORTED_Autoneg
|
11626 SUPPORTED_Asym_Pause
),
11627 .media_type
= ETH_PHY_BASE_T
,
11629 .req_flow_ctrl
= 0,
11630 .req_line_speed
= 0,
11631 .speed_cap_mask
= 0,
11634 .config_init
= (config_init_t
)bnx2x_848x3_config_init
,
11635 .read_status
= (read_status_t
)bnx2x_848xx_read_status
,
11636 .link_reset
= (link_reset_t
)bnx2x_848x3_link_reset
,
11637 .config_loopback
= (config_loopback_t
)NULL
,
11638 .format_fw_ver
= (format_fw_ver_t
)bnx2x_848xx_format_ver
,
11639 .hw_reset
= (hw_reset_t
)bnx2x_84833_hw_reset_phy
,
11640 .set_link_led
= (set_link_led_t
)bnx2x_848xx_set_link_led
,
11641 .phy_specific_func
= (phy_specific_func_t
)bnx2x_848xx_specific_func
11644 static const struct bnx2x_phy phy_84834
= {
11645 .type
= PORT_HW_CFG_XGXS_EXT_PHY_TYPE_BCM84834
,
11648 .flags
= FLAGS_FAN_FAILURE_DET_REQ
|
11649 FLAGS_REARM_LATCH_SIGNAL
,
11650 .rx_preemphasis
= {0xffff, 0xffff, 0xffff, 0xffff},
11651 .tx_preemphasis
= {0xffff, 0xffff, 0xffff, 0xffff},
11653 .supported
= (SUPPORTED_100baseT_Half
|
11654 SUPPORTED_100baseT_Full
|
11655 SUPPORTED_1000baseT_Full
|
11656 SUPPORTED_10000baseT_Full
|
11658 SUPPORTED_Autoneg
|
11660 SUPPORTED_Asym_Pause
),
11661 .media_type
= ETH_PHY_BASE_T
,
11663 .req_flow_ctrl
= 0,
11664 .req_line_speed
= 0,
11665 .speed_cap_mask
= 0,
11668 .config_init
= (config_init_t
)bnx2x_848x3_config_init
,
11669 .read_status
= (read_status_t
)bnx2x_848xx_read_status
,
11670 .link_reset
= (link_reset_t
)bnx2x_848x3_link_reset
,
11671 .config_loopback
= (config_loopback_t
)NULL
,
11672 .format_fw_ver
= (format_fw_ver_t
)bnx2x_848xx_format_ver
,
11673 .hw_reset
= (hw_reset_t
)bnx2x_84833_hw_reset_phy
,
11674 .set_link_led
= (set_link_led_t
)bnx2x_848xx_set_link_led
,
11675 .phy_specific_func
= (phy_specific_func_t
)bnx2x_848xx_specific_func
11678 static const struct bnx2x_phy phy_54618se
= {
11679 .type
= PORT_HW_CFG_XGXS_EXT_PHY_TYPE_BCM54618SE
,
11682 .flags
= FLAGS_INIT_XGXS_FIRST
,
11683 .rx_preemphasis
= {0xffff, 0xffff, 0xffff, 0xffff},
11684 .tx_preemphasis
= {0xffff, 0xffff, 0xffff, 0xffff},
11686 .supported
= (SUPPORTED_10baseT_Half
|
11687 SUPPORTED_10baseT_Full
|
11688 SUPPORTED_100baseT_Half
|
11689 SUPPORTED_100baseT_Full
|
11690 SUPPORTED_1000baseT_Full
|
11692 SUPPORTED_Autoneg
|
11694 SUPPORTED_Asym_Pause
),
11695 .media_type
= ETH_PHY_BASE_T
,
11697 .req_flow_ctrl
= 0,
11698 .req_line_speed
= 0,
11699 .speed_cap_mask
= 0,
11700 /* req_duplex = */0,
11702 .config_init
= (config_init_t
)bnx2x_54618se_config_init
,
11703 .read_status
= (read_status_t
)bnx2x_54618se_read_status
,
11704 .link_reset
= (link_reset_t
)bnx2x_54618se_link_reset
,
11705 .config_loopback
= (config_loopback_t
)bnx2x_54618se_config_loopback
,
11706 .format_fw_ver
= (format_fw_ver_t
)NULL
,
11707 .hw_reset
= (hw_reset_t
)NULL
,
11708 .set_link_led
= (set_link_led_t
)bnx2x_5461x_set_link_led
,
11709 .phy_specific_func
= (phy_specific_func_t
)bnx2x_54618se_specific_func
11711 /*****************************************************************/
11713 /* Populate the phy according. Main function: bnx2x_populate_phy */
11715 /*****************************************************************/
11717 static void bnx2x_populate_preemphasis(struct bnx2x
*bp
, u32 shmem_base
,
11718 struct bnx2x_phy
*phy
, u8 port
,
11721 /* Get the 4 lanes xgxs config rx and tx */
11722 u32 rx
= 0, tx
= 0, i
;
11723 for (i
= 0; i
< 2; i
++) {
11724 /* INT_PHY and EXT_PHY1 share the same value location in
11725 * the shmem. When num_phys is greater than 1, than this value
11726 * applies only to EXT_PHY1
11728 if (phy_index
== INT_PHY
|| phy_index
== EXT_PHY1
) {
11729 rx
= REG_RD(bp
, shmem_base
+
11730 offsetof(struct shmem_region
,
11731 dev_info
.port_hw_config
[port
].xgxs_config_rx
[i
<<1]));
11733 tx
= REG_RD(bp
, shmem_base
+
11734 offsetof(struct shmem_region
,
11735 dev_info
.port_hw_config
[port
].xgxs_config_tx
[i
<<1]));
11737 rx
= REG_RD(bp
, shmem_base
+
11738 offsetof(struct shmem_region
,
11739 dev_info
.port_hw_config
[port
].xgxs_config2_rx
[i
<<1]));
11741 tx
= REG_RD(bp
, shmem_base
+
11742 offsetof(struct shmem_region
,
11743 dev_info
.port_hw_config
[port
].xgxs_config2_rx
[i
<<1]));
11746 phy
->rx_preemphasis
[i
<< 1] = ((rx
>>16) & 0xffff);
11747 phy
->rx_preemphasis
[(i
<< 1) + 1] = (rx
& 0xffff);
11749 phy
->tx_preemphasis
[i
<< 1] = ((tx
>>16) & 0xffff);
11750 phy
->tx_preemphasis
[(i
<< 1) + 1] = (tx
& 0xffff);
11754 static u32
bnx2x_get_ext_phy_config(struct bnx2x
*bp
, u32 shmem_base
,
11755 u8 phy_index
, u8 port
)
11757 u32 ext_phy_config
= 0;
11758 switch (phy_index
) {
11760 ext_phy_config
= REG_RD(bp
, shmem_base
+
11761 offsetof(struct shmem_region
,
11762 dev_info
.port_hw_config
[port
].external_phy_config
));
11765 ext_phy_config
= REG_RD(bp
, shmem_base
+
11766 offsetof(struct shmem_region
,
11767 dev_info
.port_hw_config
[port
].external_phy_config2
));
11770 DP(NETIF_MSG_LINK
, "Invalid phy_index %d\n", phy_index
);
11774 return ext_phy_config
;
11776 static int bnx2x_populate_int_phy(struct bnx2x
*bp
, u32 shmem_base
, u8 port
,
11777 struct bnx2x_phy
*phy
)
11781 u32 switch_cfg
= (REG_RD(bp
, shmem_base
+
11782 offsetof(struct shmem_region
,
11783 dev_info
.port_feature_config
[port
].link_config
)) &
11784 PORT_FEATURE_CONNECTED_SWITCH_MASK
);
11785 chip_id
= (REG_RD(bp
, MISC_REG_CHIP_NUM
) << 16) |
11786 ((REG_RD(bp
, MISC_REG_CHIP_REV
) & 0xf) << 12);
11788 DP(NETIF_MSG_LINK
, ":chip_id = 0x%x\n", chip_id
);
11789 if (USES_WARPCORE(bp
)) {
11791 phy_addr
= REG_RD(bp
,
11792 MISC_REG_WC0_CTRL_PHY_ADDR
);
11793 *phy
= phy_warpcore
;
11794 if (REG_RD(bp
, MISC_REG_PORT4MODE_EN_OVWR
) == 0x3)
11795 phy
->flags
|= FLAGS_4_PORT_MODE
;
11797 phy
->flags
&= ~FLAGS_4_PORT_MODE
;
11798 /* Check Dual mode */
11799 serdes_net_if
= (REG_RD(bp
, shmem_base
+
11800 offsetof(struct shmem_region
, dev_info
.
11801 port_hw_config
[port
].default_cfg
)) &
11802 PORT_HW_CFG_NET_SERDES_IF_MASK
);
11803 /* Set the appropriate supported and flags indications per
11804 * interface type of the chip
11806 switch (serdes_net_if
) {
11807 case PORT_HW_CFG_NET_SERDES_IF_SGMII
:
11808 phy
->supported
&= (SUPPORTED_10baseT_Half
|
11809 SUPPORTED_10baseT_Full
|
11810 SUPPORTED_100baseT_Half
|
11811 SUPPORTED_100baseT_Full
|
11812 SUPPORTED_1000baseT_Full
|
11814 SUPPORTED_Autoneg
|
11816 SUPPORTED_Asym_Pause
);
11817 phy
->media_type
= ETH_PHY_BASE_T
;
11819 case PORT_HW_CFG_NET_SERDES_IF_XFI
:
11820 phy
->supported
&= (SUPPORTED_1000baseT_Full
|
11821 SUPPORTED_10000baseT_Full
|
11824 SUPPORTED_Asym_Pause
);
11825 phy
->media_type
= ETH_PHY_XFP_FIBER
;
11827 case PORT_HW_CFG_NET_SERDES_IF_SFI
:
11828 phy
->supported
&= (SUPPORTED_1000baseT_Full
|
11829 SUPPORTED_10000baseT_Full
|
11832 SUPPORTED_Asym_Pause
);
11833 phy
->media_type
= ETH_PHY_SFPP_10G_FIBER
;
11835 case PORT_HW_CFG_NET_SERDES_IF_KR
:
11836 phy
->media_type
= ETH_PHY_KR
;
11837 phy
->supported
&= (SUPPORTED_1000baseT_Full
|
11838 SUPPORTED_10000baseT_Full
|
11840 SUPPORTED_Autoneg
|
11842 SUPPORTED_Asym_Pause
);
11844 case PORT_HW_CFG_NET_SERDES_IF_DXGXS
:
11845 phy
->media_type
= ETH_PHY_KR
;
11846 phy
->flags
|= FLAGS_WC_DUAL_MODE
;
11847 phy
->supported
&= (SUPPORTED_20000baseMLD2_Full
|
11850 SUPPORTED_Asym_Pause
);
11852 case PORT_HW_CFG_NET_SERDES_IF_KR2
:
11853 phy
->media_type
= ETH_PHY_KR
;
11854 phy
->flags
|= FLAGS_WC_DUAL_MODE
;
11855 phy
->supported
&= (SUPPORTED_20000baseKR2_Full
|
11856 SUPPORTED_10000baseT_Full
|
11857 SUPPORTED_1000baseT_Full
|
11858 SUPPORTED_Autoneg
|
11861 SUPPORTED_Asym_Pause
);
11862 phy
->flags
&= ~FLAGS_TX_ERROR_CHECK
;
11865 DP(NETIF_MSG_LINK
, "Unknown WC interface type 0x%x\n",
11870 /* Enable MDC/MDIO work-around for E3 A0 since free running MDC
11871 * was not set as expected. For B0, ECO will be enabled so there
11872 * won't be an issue there
11874 if (CHIP_REV(bp
) == CHIP_REV_Ax
)
11875 phy
->flags
|= FLAGS_MDC_MDIO_WA
;
11877 phy
->flags
|= FLAGS_MDC_MDIO_WA_B0
;
11879 switch (switch_cfg
) {
11880 case SWITCH_CFG_1G
:
11881 phy_addr
= REG_RD(bp
,
11882 NIG_REG_SERDES0_CTRL_PHY_ADDR
+
11886 case SWITCH_CFG_10G
:
11887 phy_addr
= REG_RD(bp
,
11888 NIG_REG_XGXS0_CTRL_PHY_ADDR
+
11893 DP(NETIF_MSG_LINK
, "Invalid switch_cfg\n");
11897 phy
->addr
= (u8
)phy_addr
;
11898 phy
->mdio_ctrl
= bnx2x_get_emac_base(bp
,
11899 SHARED_HW_CFG_MDC_MDIO_ACCESS1_BOTH
,
11901 if (CHIP_IS_E2(bp
))
11902 phy
->def_md_devad
= E2_DEFAULT_PHY_DEV_ADDR
;
11904 phy
->def_md_devad
= DEFAULT_PHY_DEV_ADDR
;
11906 DP(NETIF_MSG_LINK
, "Internal phy port=%d, addr=0x%x, mdio_ctl=0x%x\n",
11907 port
, phy
->addr
, phy
->mdio_ctrl
);
11909 bnx2x_populate_preemphasis(bp
, shmem_base
, phy
, port
, INT_PHY
);
11913 static int bnx2x_populate_ext_phy(struct bnx2x
*bp
,
11918 struct bnx2x_phy
*phy
)
11920 u32 ext_phy_config
, phy_type
, config2
;
11921 u32 mdc_mdio_access
= SHARED_HW_CFG_MDC_MDIO_ACCESS1_BOTH
;
11922 ext_phy_config
= bnx2x_get_ext_phy_config(bp
, shmem_base
,
11924 phy_type
= XGXS_EXT_PHY_TYPE(ext_phy_config
);
11925 /* Select the phy type */
11926 switch (phy_type
) {
11927 case PORT_HW_CFG_XGXS_EXT_PHY_TYPE_BCM8073
:
11928 mdc_mdio_access
= SHARED_HW_CFG_MDC_MDIO_ACCESS1_SWAPPED
;
11931 case PORT_HW_CFG_XGXS_EXT_PHY_TYPE_BCM8705
:
11934 case PORT_HW_CFG_XGXS_EXT_PHY_TYPE_BCM8706
:
11937 case PORT_HW_CFG_XGXS_EXT_PHY_TYPE_BCM8726
:
11938 mdc_mdio_access
= SHARED_HW_CFG_MDC_MDIO_ACCESS1_EMAC1
;
11941 case PORT_HW_CFG_XGXS_EXT_PHY_TYPE_BCM8727_NOC
:
11942 /* BCM8727_NOC => BCM8727 no over current */
11943 mdc_mdio_access
= SHARED_HW_CFG_MDC_MDIO_ACCESS1_EMAC1
;
11945 phy
->flags
|= FLAGS_NOC
;
11947 case PORT_HW_CFG_XGXS_EXT_PHY_TYPE_BCM8722
:
11948 case PORT_HW_CFG_XGXS_EXT_PHY_TYPE_BCM8727
:
11949 mdc_mdio_access
= SHARED_HW_CFG_MDC_MDIO_ACCESS1_EMAC1
;
11952 case PORT_HW_CFG_XGXS_EXT_PHY_TYPE_BCM8481
:
11955 case PORT_HW_CFG_XGXS_EXT_PHY_TYPE_BCM84823
:
11958 case PORT_HW_CFG_XGXS_EXT_PHY_TYPE_BCM84833
:
11961 case PORT_HW_CFG_XGXS_EXT_PHY_TYPE_BCM84834
:
11964 case PORT_HW_CFG_XGXS_EXT_PHY_TYPE_BCM54616
:
11965 case PORT_HW_CFG_XGXS_EXT_PHY_TYPE_BCM54618SE
:
11966 *phy
= phy_54618se
;
11967 if (phy_type
== PORT_HW_CFG_XGXS_EXT_PHY_TYPE_BCM54618SE
)
11968 phy
->flags
|= FLAGS_EEE
;
11970 case PORT_HW_CFG_XGXS_EXT_PHY_TYPE_SFX7101
:
11973 case PORT_HW_CFG_XGXS_EXT_PHY_TYPE_FAILURE
:
11978 /* In case external PHY wasn't found */
11979 if ((phy_type
!= PORT_HW_CFG_XGXS_EXT_PHY_TYPE_DIRECT
) &&
11980 (phy_type
!= PORT_HW_CFG_XGXS_EXT_PHY_TYPE_NOT_CONN
))
11985 phy
->addr
= XGXS_EXT_PHY_ADDR(ext_phy_config
);
11986 bnx2x_populate_preemphasis(bp
, shmem_base
, phy
, port
, phy_index
);
11988 /* The shmem address of the phy version is located on different
11989 * structures. In case this structure is too old, do not set
11992 config2
= REG_RD(bp
, shmem_base
+ offsetof(struct shmem_region
,
11993 dev_info
.shared_hw_config
.config2
));
11994 if (phy_index
== EXT_PHY1
) {
11995 phy
->ver_addr
= shmem_base
+ offsetof(struct shmem_region
,
11996 port_mb
[port
].ext_phy_fw_version
);
11998 /* Check specific mdc mdio settings */
11999 if (config2
& SHARED_HW_CFG_MDC_MDIO_ACCESS1_MASK
)
12000 mdc_mdio_access
= config2
&
12001 SHARED_HW_CFG_MDC_MDIO_ACCESS1_MASK
;
12003 u32 size
= REG_RD(bp
, shmem2_base
);
12006 offsetof(struct shmem2_region
, ext_phy_fw_version2
)) {
12007 phy
->ver_addr
= shmem2_base
+
12008 offsetof(struct shmem2_region
,
12009 ext_phy_fw_version2
[port
]);
12011 /* Check specific mdc mdio settings */
12012 if (config2
& SHARED_HW_CFG_MDC_MDIO_ACCESS2_MASK
)
12013 mdc_mdio_access
= (config2
&
12014 SHARED_HW_CFG_MDC_MDIO_ACCESS2_MASK
) >>
12015 (SHARED_HW_CFG_MDC_MDIO_ACCESS2_SHIFT
-
12016 SHARED_HW_CFG_MDC_MDIO_ACCESS1_SHIFT
);
12018 phy
->mdio_ctrl
= bnx2x_get_emac_base(bp
, mdc_mdio_access
, port
);
12020 if (((phy
->type
== PORT_HW_CFG_XGXS_EXT_PHY_TYPE_BCM84833
) ||
12021 (phy
->type
== PORT_HW_CFG_XGXS_EXT_PHY_TYPE_BCM84834
)) &&
12023 /* Remove 100Mb link supported for BCM84833/4 when phy fw
12024 * version lower than or equal to 1.39
12026 u32 raw_ver
= REG_RD(bp
, phy
->ver_addr
);
12027 if (((raw_ver
& 0x7F) <= 39) &&
12028 (((raw_ver
& 0xF80) >> 7) <= 1))
12029 phy
->supported
&= ~(SUPPORTED_100baseT_Half
|
12030 SUPPORTED_100baseT_Full
);
12033 DP(NETIF_MSG_LINK
, "phy_type 0x%x port %d found in index %d\n",
12034 phy_type
, port
, phy_index
);
12035 DP(NETIF_MSG_LINK
, " addr=0x%x, mdio_ctl=0x%x\n",
12036 phy
->addr
, phy
->mdio_ctrl
);
12040 static int bnx2x_populate_phy(struct bnx2x
*bp
, u8 phy_index
, u32 shmem_base
,
12041 u32 shmem2_base
, u8 port
, struct bnx2x_phy
*phy
)
12044 phy
->type
= PORT_HW_CFG_XGXS_EXT_PHY_TYPE_NOT_CONN
;
12045 if (phy_index
== INT_PHY
)
12046 return bnx2x_populate_int_phy(bp
, shmem_base
, port
, phy
);
12047 status
= bnx2x_populate_ext_phy(bp
, phy_index
, shmem_base
, shmem2_base
,
12052 static void bnx2x_phy_def_cfg(struct link_params
*params
,
12053 struct bnx2x_phy
*phy
,
12056 struct bnx2x
*bp
= params
->bp
;
12058 /* Populate the default phy configuration for MF mode */
12059 if (phy_index
== EXT_PHY2
) {
12060 link_config
= REG_RD(bp
, params
->shmem_base
+
12061 offsetof(struct shmem_region
, dev_info
.
12062 port_feature_config
[params
->port
].link_config2
));
12063 phy
->speed_cap_mask
= REG_RD(bp
, params
->shmem_base
+
12064 offsetof(struct shmem_region
,
12066 port_hw_config
[params
->port
].speed_capability_mask2
));
12068 link_config
= REG_RD(bp
, params
->shmem_base
+
12069 offsetof(struct shmem_region
, dev_info
.
12070 port_feature_config
[params
->port
].link_config
));
12071 phy
->speed_cap_mask
= REG_RD(bp
, params
->shmem_base
+
12072 offsetof(struct shmem_region
,
12074 port_hw_config
[params
->port
].speed_capability_mask
));
12077 "Default config phy idx %x cfg 0x%x speed_cap_mask 0x%x\n",
12078 phy_index
, link_config
, phy
->speed_cap_mask
);
12080 phy
->req_duplex
= DUPLEX_FULL
;
12081 switch (link_config
& PORT_FEATURE_LINK_SPEED_MASK
) {
12082 case PORT_FEATURE_LINK_SPEED_10M_HALF
:
12083 phy
->req_duplex
= DUPLEX_HALF
;
12084 case PORT_FEATURE_LINK_SPEED_10M_FULL
:
12085 phy
->req_line_speed
= SPEED_10
;
12087 case PORT_FEATURE_LINK_SPEED_100M_HALF
:
12088 phy
->req_duplex
= DUPLEX_HALF
;
12089 case PORT_FEATURE_LINK_SPEED_100M_FULL
:
12090 phy
->req_line_speed
= SPEED_100
;
12092 case PORT_FEATURE_LINK_SPEED_1G
:
12093 phy
->req_line_speed
= SPEED_1000
;
12095 case PORT_FEATURE_LINK_SPEED_2_5G
:
12096 phy
->req_line_speed
= SPEED_2500
;
12098 case PORT_FEATURE_LINK_SPEED_10G_CX4
:
12099 phy
->req_line_speed
= SPEED_10000
;
12102 phy
->req_line_speed
= SPEED_AUTO_NEG
;
12106 switch (link_config
& PORT_FEATURE_FLOW_CONTROL_MASK
) {
12107 case PORT_FEATURE_FLOW_CONTROL_AUTO
:
12108 phy
->req_flow_ctrl
= BNX2X_FLOW_CTRL_AUTO
;
12110 case PORT_FEATURE_FLOW_CONTROL_TX
:
12111 phy
->req_flow_ctrl
= BNX2X_FLOW_CTRL_TX
;
12113 case PORT_FEATURE_FLOW_CONTROL_RX
:
12114 phy
->req_flow_ctrl
= BNX2X_FLOW_CTRL_RX
;
12116 case PORT_FEATURE_FLOW_CONTROL_BOTH
:
12117 phy
->req_flow_ctrl
= BNX2X_FLOW_CTRL_BOTH
;
12120 phy
->req_flow_ctrl
= BNX2X_FLOW_CTRL_NONE
;
12125 u32
bnx2x_phy_selection(struct link_params
*params
)
12127 u32 phy_config_swapped
, prio_cfg
;
12128 u32 return_cfg
= PORT_HW_CFG_PHY_SELECTION_HARDWARE_DEFAULT
;
12130 phy_config_swapped
= params
->multi_phy_config
&
12131 PORT_HW_CFG_PHY_SWAPPED_ENABLED
;
12133 prio_cfg
= params
->multi_phy_config
&
12134 PORT_HW_CFG_PHY_SELECTION_MASK
;
12136 if (phy_config_swapped
) {
12137 switch (prio_cfg
) {
12138 case PORT_HW_CFG_PHY_SELECTION_FIRST_PHY_PRIORITY
:
12139 return_cfg
= PORT_HW_CFG_PHY_SELECTION_SECOND_PHY_PRIORITY
;
12141 case PORT_HW_CFG_PHY_SELECTION_SECOND_PHY_PRIORITY
:
12142 return_cfg
= PORT_HW_CFG_PHY_SELECTION_FIRST_PHY_PRIORITY
;
12144 case PORT_HW_CFG_PHY_SELECTION_SECOND_PHY
:
12145 return_cfg
= PORT_HW_CFG_PHY_SELECTION_FIRST_PHY
;
12147 case PORT_HW_CFG_PHY_SELECTION_FIRST_PHY
:
12148 return_cfg
= PORT_HW_CFG_PHY_SELECTION_SECOND_PHY
;
12152 return_cfg
= prio_cfg
;
12157 int bnx2x_phy_probe(struct link_params
*params
)
12159 u8 phy_index
, actual_phy_idx
;
12160 u32 phy_config_swapped
, sync_offset
, media_types
;
12161 struct bnx2x
*bp
= params
->bp
;
12162 struct bnx2x_phy
*phy
;
12163 params
->num_phys
= 0;
12164 DP(NETIF_MSG_LINK
, "Begin phy probe\n");
12165 phy_config_swapped
= params
->multi_phy_config
&
12166 PORT_HW_CFG_PHY_SWAPPED_ENABLED
;
12168 for (phy_index
= INT_PHY
; phy_index
< MAX_PHYS
;
12170 actual_phy_idx
= phy_index
;
12171 if (phy_config_swapped
) {
12172 if (phy_index
== EXT_PHY1
)
12173 actual_phy_idx
= EXT_PHY2
;
12174 else if (phy_index
== EXT_PHY2
)
12175 actual_phy_idx
= EXT_PHY1
;
12177 DP(NETIF_MSG_LINK
, "phy_config_swapped %x, phy_index %x,"
12178 " actual_phy_idx %x\n", phy_config_swapped
,
12179 phy_index
, actual_phy_idx
);
12180 phy
= ¶ms
->phy
[actual_phy_idx
];
12181 if (bnx2x_populate_phy(bp
, phy_index
, params
->shmem_base
,
12182 params
->shmem2_base
, params
->port
,
12184 params
->num_phys
= 0;
12185 DP(NETIF_MSG_LINK
, "phy probe failed in phy index %d\n",
12187 for (phy_index
= INT_PHY
;
12188 phy_index
< MAX_PHYS
;
12193 if (phy
->type
== PORT_HW_CFG_XGXS_EXT_PHY_TYPE_NOT_CONN
)
12196 if (params
->feature_config_flags
&
12197 FEATURE_CONFIG_DISABLE_REMOTE_FAULT_DET
)
12198 phy
->flags
&= ~FLAGS_TX_ERROR_CHECK
;
12200 if (!(params
->feature_config_flags
&
12201 FEATURE_CONFIG_MT_SUPPORT
))
12202 phy
->flags
|= FLAGS_MDC_MDIO_WA_G
;
12204 sync_offset
= params
->shmem_base
+
12205 offsetof(struct shmem_region
,
12206 dev_info
.port_hw_config
[params
->port
].media_type
);
12207 media_types
= REG_RD(bp
, sync_offset
);
12209 /* Update media type for non-PMF sync only for the first time
12210 * In case the media type changes afterwards, it will be updated
12211 * using the update_status function
12213 if ((media_types
& (PORT_HW_CFG_MEDIA_TYPE_PHY0_MASK
<<
12214 (PORT_HW_CFG_MEDIA_TYPE_PHY1_SHIFT
*
12215 actual_phy_idx
))) == 0) {
12216 media_types
|= ((phy
->media_type
&
12217 PORT_HW_CFG_MEDIA_TYPE_PHY0_MASK
) <<
12218 (PORT_HW_CFG_MEDIA_TYPE_PHY1_SHIFT
*
12221 REG_WR(bp
, sync_offset
, media_types
);
12223 bnx2x_phy_def_cfg(params
, phy
, phy_index
);
12224 params
->num_phys
++;
12227 DP(NETIF_MSG_LINK
, "End phy probe. #phys found %x\n", params
->num_phys
);
12231 static void bnx2x_init_bmac_loopback(struct link_params
*params
,
12232 struct link_vars
*vars
)
12234 struct bnx2x
*bp
= params
->bp
;
12236 vars
->line_speed
= SPEED_10000
;
12237 vars
->duplex
= DUPLEX_FULL
;
12238 vars
->flow_ctrl
= BNX2X_FLOW_CTRL_NONE
;
12239 vars
->mac_type
= MAC_TYPE_BMAC
;
12241 vars
->phy_flags
= PHY_XGXS_FLAG
;
12243 bnx2x_xgxs_deassert(params
);
12245 /* set bmac loopback */
12246 bnx2x_bmac_enable(params
, vars
, 1, 1);
12248 REG_WR(bp
, NIG_REG_EGRESS_DRAIN0_MODE
+ params
->port
*4, 0);
12251 static void bnx2x_init_emac_loopback(struct link_params
*params
,
12252 struct link_vars
*vars
)
12254 struct bnx2x
*bp
= params
->bp
;
12256 vars
->line_speed
= SPEED_1000
;
12257 vars
->duplex
= DUPLEX_FULL
;
12258 vars
->flow_ctrl
= BNX2X_FLOW_CTRL_NONE
;
12259 vars
->mac_type
= MAC_TYPE_EMAC
;
12261 vars
->phy_flags
= PHY_XGXS_FLAG
;
12263 bnx2x_xgxs_deassert(params
);
12264 /* set bmac loopback */
12265 bnx2x_emac_enable(params
, vars
, 1);
12266 bnx2x_emac_program(params
, vars
);
12267 REG_WR(bp
, NIG_REG_EGRESS_DRAIN0_MODE
+ params
->port
*4, 0);
12270 static void bnx2x_init_xmac_loopback(struct link_params
*params
,
12271 struct link_vars
*vars
)
12273 struct bnx2x
*bp
= params
->bp
;
12275 if (!params
->req_line_speed
[0])
12276 vars
->line_speed
= SPEED_10000
;
12278 vars
->line_speed
= params
->req_line_speed
[0];
12279 vars
->duplex
= DUPLEX_FULL
;
12280 vars
->flow_ctrl
= BNX2X_FLOW_CTRL_NONE
;
12281 vars
->mac_type
= MAC_TYPE_XMAC
;
12282 vars
->phy_flags
= PHY_XGXS_FLAG
;
12283 /* Set WC to loopback mode since link is required to provide clock
12284 * to the XMAC in 20G mode
12286 bnx2x_set_aer_mmd(params
, ¶ms
->phy
[0]);
12287 bnx2x_warpcore_reset_lane(bp
, ¶ms
->phy
[0], 0);
12288 params
->phy
[INT_PHY
].config_loopback(
12289 ¶ms
->phy
[INT_PHY
],
12292 bnx2x_xmac_enable(params
, vars
, 1);
12293 REG_WR(bp
, NIG_REG_EGRESS_DRAIN0_MODE
+ params
->port
*4, 0);
12296 static void bnx2x_init_umac_loopback(struct link_params
*params
,
12297 struct link_vars
*vars
)
12299 struct bnx2x
*bp
= params
->bp
;
12301 vars
->line_speed
= SPEED_1000
;
12302 vars
->duplex
= DUPLEX_FULL
;
12303 vars
->flow_ctrl
= BNX2X_FLOW_CTRL_NONE
;
12304 vars
->mac_type
= MAC_TYPE_UMAC
;
12305 vars
->phy_flags
= PHY_XGXS_FLAG
;
12306 bnx2x_umac_enable(params
, vars
, 1);
12308 REG_WR(bp
, NIG_REG_EGRESS_DRAIN0_MODE
+ params
->port
*4, 0);
12311 static void bnx2x_init_xgxs_loopback(struct link_params
*params
,
12312 struct link_vars
*vars
)
12314 struct bnx2x
*bp
= params
->bp
;
12315 struct bnx2x_phy
*int_phy
= ¶ms
->phy
[INT_PHY
];
12317 vars
->flow_ctrl
= BNX2X_FLOW_CTRL_NONE
;
12318 vars
->duplex
= DUPLEX_FULL
;
12319 if (params
->req_line_speed
[0] == SPEED_1000
)
12320 vars
->line_speed
= SPEED_1000
;
12321 else if ((params
->req_line_speed
[0] == SPEED_20000
) ||
12322 (int_phy
->flags
& FLAGS_WC_DUAL_MODE
))
12323 vars
->line_speed
= SPEED_20000
;
12325 vars
->line_speed
= SPEED_10000
;
12327 if (!USES_WARPCORE(bp
))
12328 bnx2x_xgxs_deassert(params
);
12329 bnx2x_link_initialize(params
, vars
);
12331 if (params
->req_line_speed
[0] == SPEED_1000
) {
12332 if (USES_WARPCORE(bp
))
12333 bnx2x_umac_enable(params
, vars
, 0);
12335 bnx2x_emac_program(params
, vars
);
12336 bnx2x_emac_enable(params
, vars
, 0);
12339 if (USES_WARPCORE(bp
))
12340 bnx2x_xmac_enable(params
, vars
, 0);
12342 bnx2x_bmac_enable(params
, vars
, 0, 1);
12345 if (params
->loopback_mode
== LOOPBACK_XGXS
) {
12346 /* Set 10G XGXS loopback */
12347 int_phy
->config_loopback(int_phy
, params
);
12349 /* Set external phy loopback */
12351 for (phy_index
= EXT_PHY1
;
12352 phy_index
< params
->num_phys
; phy_index
++)
12353 if (params
->phy
[phy_index
].config_loopback
)
12354 params
->phy
[phy_index
].config_loopback(
12355 ¶ms
->phy
[phy_index
],
12358 REG_WR(bp
, NIG_REG_EGRESS_DRAIN0_MODE
+ params
->port
*4, 0);
12360 bnx2x_set_led(params
, vars
, LED_MODE_OPER
, vars
->line_speed
);
12363 void bnx2x_set_rx_filter(struct link_params
*params
, u8 en
)
12365 struct bnx2x
*bp
= params
->bp
;
12366 u8 val
= en
* 0x1F;
12368 /* Open / close the gate between the NIG and the BRB */
12369 if (!CHIP_IS_E1x(bp
))
12371 REG_WR(bp
, NIG_REG_LLH0_BRB1_DRV_MASK
+ params
->port
*4, val
);
12373 if (!CHIP_IS_E1(bp
)) {
12374 REG_WR(bp
, NIG_REG_LLH0_BRB1_DRV_MASK_MF
+ params
->port
*4,
12378 REG_WR(bp
, (params
->port
? NIG_REG_LLH1_BRB1_NOT_MCP
:
12379 NIG_REG_LLH0_BRB1_NOT_MCP
), en
);
12381 static int bnx2x_avoid_link_flap(struct link_params
*params
,
12382 struct link_vars
*vars
)
12385 u32 dont_clear_stat
, lfa_sts
;
12386 struct bnx2x
*bp
= params
->bp
;
12388 /* Sync the link parameters */
12389 bnx2x_link_status_update(params
, vars
);
12392 * The module verification was already done by previous link owner,
12393 * so this call is meant only to get warning message
12396 for (phy_idx
= INT_PHY
; phy_idx
< params
->num_phys
; phy_idx
++) {
12397 struct bnx2x_phy
*phy
= ¶ms
->phy
[phy_idx
];
12398 if (phy
->phy_specific_func
) {
12399 DP(NETIF_MSG_LINK
, "Calling PHY specific func\n");
12400 phy
->phy_specific_func(phy
, params
, PHY_INIT
);
12402 if ((phy
->media_type
== ETH_PHY_SFPP_10G_FIBER
) ||
12403 (phy
->media_type
== ETH_PHY_SFP_1G_FIBER
) ||
12404 (phy
->media_type
== ETH_PHY_DA_TWINAX
))
12405 bnx2x_verify_sfp_module(phy
, params
);
12407 lfa_sts
= REG_RD(bp
, params
->lfa_base
+
12408 offsetof(struct shmem_lfa
,
12411 dont_clear_stat
= lfa_sts
& SHMEM_LFA_DONT_CLEAR_STAT
;
12413 /* Re-enable the NIG/MAC */
12414 if (CHIP_IS_E3(bp
)) {
12415 if (!dont_clear_stat
) {
12416 REG_WR(bp
, GRCBASE_MISC
+
12417 MISC_REGISTERS_RESET_REG_2_CLEAR
,
12418 (MISC_REGISTERS_RESET_REG_2_MSTAT0
<<
12420 REG_WR(bp
, GRCBASE_MISC
+
12421 MISC_REGISTERS_RESET_REG_2_SET
,
12422 (MISC_REGISTERS_RESET_REG_2_MSTAT0
<<
12425 if (vars
->line_speed
< SPEED_10000
)
12426 bnx2x_umac_enable(params
, vars
, 0);
12428 bnx2x_xmac_enable(params
, vars
, 0);
12430 if (vars
->line_speed
< SPEED_10000
)
12431 bnx2x_emac_enable(params
, vars
, 0);
12433 bnx2x_bmac_enable(params
, vars
, 0, !dont_clear_stat
);
12436 /* Increment LFA count */
12437 lfa_sts
= ((lfa_sts
& ~LINK_FLAP_AVOIDANCE_COUNT_MASK
) |
12438 (((((lfa_sts
& LINK_FLAP_AVOIDANCE_COUNT_MASK
) >>
12439 LINK_FLAP_AVOIDANCE_COUNT_OFFSET
) + 1) & 0xff)
12440 << LINK_FLAP_AVOIDANCE_COUNT_OFFSET
));
12441 /* Clear link flap reason */
12442 lfa_sts
&= ~LFA_LINK_FLAP_REASON_MASK
;
12444 REG_WR(bp
, params
->lfa_base
+
12445 offsetof(struct shmem_lfa
, lfa_sts
), lfa_sts
);
12447 /* Disable NIG DRAIN */
12448 REG_WR(bp
, NIG_REG_EGRESS_DRAIN0_MODE
+ params
->port
*4, 0);
12450 /* Enable interrupts */
12451 bnx2x_link_int_enable(params
);
12455 static void bnx2x_cannot_avoid_link_flap(struct link_params
*params
,
12456 struct link_vars
*vars
,
12459 u32 lfa_sts
, cfg_idx
, tmp_val
;
12460 struct bnx2x
*bp
= params
->bp
;
12462 bnx2x_link_reset(params
, vars
, 1);
12464 if (!params
->lfa_base
)
12466 /* Store the new link parameters */
12467 REG_WR(bp
, params
->lfa_base
+
12468 offsetof(struct shmem_lfa
, req_duplex
),
12469 params
->req_duplex
[0] | (params
->req_duplex
[1] << 16));
12471 REG_WR(bp
, params
->lfa_base
+
12472 offsetof(struct shmem_lfa
, req_flow_ctrl
),
12473 params
->req_flow_ctrl
[0] | (params
->req_flow_ctrl
[1] << 16));
12475 REG_WR(bp
, params
->lfa_base
+
12476 offsetof(struct shmem_lfa
, req_line_speed
),
12477 params
->req_line_speed
[0] | (params
->req_line_speed
[1] << 16));
12479 for (cfg_idx
= 0; cfg_idx
< SHMEM_LINK_CONFIG_SIZE
; cfg_idx
++) {
12480 REG_WR(bp
, params
->lfa_base
+
12481 offsetof(struct shmem_lfa
,
12482 speed_cap_mask
[cfg_idx
]),
12483 params
->speed_cap_mask
[cfg_idx
]);
12486 tmp_val
= REG_RD(bp
, params
->lfa_base
+
12487 offsetof(struct shmem_lfa
, additional_config
));
12488 tmp_val
&= ~REQ_FC_AUTO_ADV_MASK
;
12489 tmp_val
|= params
->req_fc_auto_adv
;
12491 REG_WR(bp
, params
->lfa_base
+
12492 offsetof(struct shmem_lfa
, additional_config
), tmp_val
);
12494 lfa_sts
= REG_RD(bp
, params
->lfa_base
+
12495 offsetof(struct shmem_lfa
, lfa_sts
));
12497 /* Clear the "Don't Clear Statistics" bit, and set reason */
12498 lfa_sts
&= ~SHMEM_LFA_DONT_CLEAR_STAT
;
12500 /* Set link flap reason */
12501 lfa_sts
&= ~LFA_LINK_FLAP_REASON_MASK
;
12502 lfa_sts
|= ((lfa_status
& LFA_LINK_FLAP_REASON_MASK
) <<
12503 LFA_LINK_FLAP_REASON_OFFSET
);
12505 /* Increment link flap counter */
12506 lfa_sts
= ((lfa_sts
& ~LINK_FLAP_COUNT_MASK
) |
12507 (((((lfa_sts
& LINK_FLAP_COUNT_MASK
) >>
12508 LINK_FLAP_COUNT_OFFSET
) + 1) & 0xff)
12509 << LINK_FLAP_COUNT_OFFSET
));
12510 REG_WR(bp
, params
->lfa_base
+
12511 offsetof(struct shmem_lfa
, lfa_sts
), lfa_sts
);
12512 /* Proceed with regular link initialization */
12515 int bnx2x_phy_init(struct link_params
*params
, struct link_vars
*vars
)
12518 struct bnx2x
*bp
= params
->bp
;
12519 DP(NETIF_MSG_LINK
, "Phy Initialization started\n");
12520 DP(NETIF_MSG_LINK
, "(1) req_speed %d, req_flowctrl %d\n",
12521 params
->req_line_speed
[0], params
->req_flow_ctrl
[0]);
12522 DP(NETIF_MSG_LINK
, "(2) req_speed %d, req_flowctrl %d\n",
12523 params
->req_line_speed
[1], params
->req_flow_ctrl
[1]);
12524 vars
->link_status
= 0;
12525 vars
->phy_link_up
= 0;
12527 vars
->line_speed
= 0;
12528 vars
->duplex
= DUPLEX_FULL
;
12529 vars
->flow_ctrl
= BNX2X_FLOW_CTRL_NONE
;
12530 vars
->mac_type
= MAC_TYPE_NONE
;
12531 vars
->phy_flags
= 0;
12532 vars
->check_kr2_recovery_cnt
= 0;
12533 params
->link_flags
= PHY_INITIALIZED
;
12534 /* Driver opens NIG-BRB filters */
12535 bnx2x_set_rx_filter(params
, 1);
12536 /* Check if link flap can be avoided */
12537 lfa_status
= bnx2x_check_lfa(params
);
12539 if (lfa_status
== 0) {
12540 DP(NETIF_MSG_LINK
, "Link Flap Avoidance in progress\n");
12541 return bnx2x_avoid_link_flap(params
, vars
);
12544 DP(NETIF_MSG_LINK
, "Cannot avoid link flap lfa_sta=0x%x\n",
12546 bnx2x_cannot_avoid_link_flap(params
, vars
, lfa_status
);
12548 /* Disable attentions */
12549 bnx2x_bits_dis(bp
, NIG_REG_MASK_INTERRUPT_PORT0
+ params
->port
*4,
12550 (NIG_MASK_XGXS0_LINK_STATUS
|
12551 NIG_MASK_XGXS0_LINK10G
|
12552 NIG_MASK_SERDES0_LINK_STATUS
|
12555 bnx2x_emac_init(params
, vars
);
12557 if (params
->feature_config_flags
& FEATURE_CONFIG_PFC_ENABLED
)
12558 vars
->link_status
|= LINK_STATUS_PFC_ENABLED
;
12560 if (params
->num_phys
== 0) {
12561 DP(NETIF_MSG_LINK
, "No phy found for initialization !!\n");
12564 set_phy_vars(params
, vars
);
12566 DP(NETIF_MSG_LINK
, "Num of phys on board: %d\n", params
->num_phys
);
12567 switch (params
->loopback_mode
) {
12568 case LOOPBACK_BMAC
:
12569 bnx2x_init_bmac_loopback(params
, vars
);
12571 case LOOPBACK_EMAC
:
12572 bnx2x_init_emac_loopback(params
, vars
);
12574 case LOOPBACK_XMAC
:
12575 bnx2x_init_xmac_loopback(params
, vars
);
12577 case LOOPBACK_UMAC
:
12578 bnx2x_init_umac_loopback(params
, vars
);
12580 case LOOPBACK_XGXS
:
12581 case LOOPBACK_EXT_PHY
:
12582 bnx2x_init_xgxs_loopback(params
, vars
);
12585 if (!CHIP_IS_E3(bp
)) {
12586 if (params
->switch_cfg
== SWITCH_CFG_10G
)
12587 bnx2x_xgxs_deassert(params
);
12589 bnx2x_serdes_deassert(bp
, params
->port
);
12591 bnx2x_link_initialize(params
, vars
);
12593 bnx2x_link_int_enable(params
);
12596 bnx2x_update_mng(params
, vars
->link_status
);
12598 bnx2x_update_mng_eee(params
, vars
->eee_status
);
12602 int bnx2x_link_reset(struct link_params
*params
, struct link_vars
*vars
,
12605 struct bnx2x
*bp
= params
->bp
;
12606 u8 phy_index
, port
= params
->port
, clear_latch_ind
= 0;
12607 DP(NETIF_MSG_LINK
, "Resetting the link of port %d\n", port
);
12608 /* Disable attentions */
12609 vars
->link_status
= 0;
12610 bnx2x_update_mng(params
, vars
->link_status
);
12611 vars
->eee_status
&= ~(SHMEM_EEE_LP_ADV_STATUS_MASK
|
12612 SHMEM_EEE_ACTIVE_BIT
);
12613 bnx2x_update_mng_eee(params
, vars
->eee_status
);
12614 bnx2x_bits_dis(bp
, NIG_REG_MASK_INTERRUPT_PORT0
+ port
*4,
12615 (NIG_MASK_XGXS0_LINK_STATUS
|
12616 NIG_MASK_XGXS0_LINK10G
|
12617 NIG_MASK_SERDES0_LINK_STATUS
|
12620 /* Activate nig drain */
12621 REG_WR(bp
, NIG_REG_EGRESS_DRAIN0_MODE
+ port
*4, 1);
12623 /* Disable nig egress interface */
12624 if (!CHIP_IS_E3(bp
)) {
12625 REG_WR(bp
, NIG_REG_BMAC0_OUT_EN
+ port
*4, 0);
12626 REG_WR(bp
, NIG_REG_EGRESS_EMAC0_OUT_EN
+ port
*4, 0);
12629 if (!CHIP_IS_E3(bp
)) {
12630 bnx2x_set_bmac_rx(bp
, params
->chip_id
, port
, 0);
12632 bnx2x_set_xmac_rxtx(params
, 0);
12633 bnx2x_set_umac_rxtx(params
, 0);
12636 if (!CHIP_IS_E3(bp
))
12637 REG_WR(bp
, NIG_REG_NIG_EMAC0_EN
+ port
*4, 0);
12639 usleep_range(10000, 20000);
12640 /* The PHY reset is controlled by GPIO 1
12641 * Hold it as vars low
12643 /* Clear link led */
12644 bnx2x_set_mdio_emac_per_phy(bp
, params
);
12645 bnx2x_set_led(params
, vars
, LED_MODE_OFF
, 0);
12647 if (reset_ext_phy
) {
12648 for (phy_index
= EXT_PHY1
; phy_index
< params
->num_phys
;
12650 if (params
->phy
[phy_index
].link_reset
) {
12651 bnx2x_set_aer_mmd(params
,
12652 ¶ms
->phy
[phy_index
]);
12653 params
->phy
[phy_index
].link_reset(
12654 ¶ms
->phy
[phy_index
],
12657 if (params
->phy
[phy_index
].flags
&
12658 FLAGS_REARM_LATCH_SIGNAL
)
12659 clear_latch_ind
= 1;
12663 if (clear_latch_ind
) {
12664 /* Clear latching indication */
12665 bnx2x_rearm_latch_signal(bp
, port
, 0);
12666 bnx2x_bits_dis(bp
, NIG_REG_LATCH_BC_0
+ port
*4,
12667 1 << NIG_LATCH_BC_ENABLE_MI_INT
);
12669 if (params
->phy
[INT_PHY
].link_reset
)
12670 params
->phy
[INT_PHY
].link_reset(
12671 ¶ms
->phy
[INT_PHY
], params
);
12673 /* Disable nig ingress interface */
12674 if (!CHIP_IS_E3(bp
)) {
12676 REG_WR(bp
, GRCBASE_MISC
+ MISC_REGISTERS_RESET_REG_2_CLEAR
,
12677 (MISC_REGISTERS_RESET_REG_2_RST_BMAC0
<< port
));
12678 REG_WR(bp
, NIG_REG_BMAC0_IN_EN
+ port
*4, 0);
12679 REG_WR(bp
, NIG_REG_EMAC0_IN_EN
+ port
*4, 0);
12681 u32 xmac_base
= (params
->port
) ? GRCBASE_XMAC1
: GRCBASE_XMAC0
;
12682 bnx2x_set_xumac_nig(params
, 0, 0);
12683 if (REG_RD(bp
, MISC_REG_RESET_REG_2
) &
12684 MISC_REGISTERS_RESET_REG_2_XMAC
)
12685 REG_WR(bp
, xmac_base
+ XMAC_REG_CTRL
,
12686 XMAC_CTRL_REG_SOFT_RESET
);
12689 vars
->phy_flags
= 0;
12692 int bnx2x_lfa_reset(struct link_params
*params
,
12693 struct link_vars
*vars
)
12695 struct bnx2x
*bp
= params
->bp
;
12697 vars
->phy_flags
= 0;
12698 params
->link_flags
&= ~PHY_INITIALIZED
;
12699 if (!params
->lfa_base
)
12700 return bnx2x_link_reset(params
, vars
, 1);
12702 * Activate NIG drain so that during this time the device won't send
12703 * anything while it is unable to response.
12705 REG_WR(bp
, NIG_REG_EGRESS_DRAIN0_MODE
+ params
->port
*4, 1);
12708 * Close gracefully the gate from BMAC to NIG such that no half packets
12711 if (!CHIP_IS_E3(bp
))
12712 bnx2x_set_bmac_rx(bp
, params
->chip_id
, params
->port
, 0);
12714 if (CHIP_IS_E3(bp
)) {
12715 bnx2x_set_xmac_rxtx(params
, 0);
12716 bnx2x_set_umac_rxtx(params
, 0);
12718 /* Wait 10ms for the pipe to clean up*/
12719 usleep_range(10000, 20000);
12721 /* Clean the NIG-BRB using the network filters in a way that will
12722 * not cut a packet in the middle.
12724 bnx2x_set_rx_filter(params
, 0);
12727 * Re-open the gate between the BMAC and the NIG, after verifying the
12728 * gate to the BRB is closed, otherwise packets may arrive to the
12729 * firmware before driver had initialized it. The target is to achieve
12730 * minimum management protocol down time.
12732 if (!CHIP_IS_E3(bp
))
12733 bnx2x_set_bmac_rx(bp
, params
->chip_id
, params
->port
, 1);
12735 if (CHIP_IS_E3(bp
)) {
12736 bnx2x_set_xmac_rxtx(params
, 1);
12737 bnx2x_set_umac_rxtx(params
, 1);
12739 /* Disable NIG drain */
12740 REG_WR(bp
, NIG_REG_EGRESS_DRAIN0_MODE
+ params
->port
*4, 0);
12744 /****************************************************************************/
12745 /* Common function */
12746 /****************************************************************************/
12747 static int bnx2x_8073_common_init_phy(struct bnx2x
*bp
,
12748 u32 shmem_base_path
[],
12749 u32 shmem2_base_path
[], u8 phy_index
,
12752 struct bnx2x_phy phy
[PORT_MAX
];
12753 struct bnx2x_phy
*phy_blk
[PORT_MAX
];
12756 s8 port_of_path
= 0;
12757 u32 swap_val
, swap_override
;
12758 swap_val
= REG_RD(bp
, NIG_REG_PORT_SWAP
);
12759 swap_override
= REG_RD(bp
, NIG_REG_STRAP_OVERRIDE
);
12760 port
^= (swap_val
&& swap_override
);
12761 bnx2x_ext_phy_hw_reset(bp
, port
);
12762 /* PART1 - Reset both phys */
12763 for (port
= PORT_MAX
- 1; port
>= PORT_0
; port
--) {
12764 u32 shmem_base
, shmem2_base
;
12765 /* In E2, same phy is using for port0 of the two paths */
12766 if (CHIP_IS_E1x(bp
)) {
12767 shmem_base
= shmem_base_path
[0];
12768 shmem2_base
= shmem2_base_path
[0];
12769 port_of_path
= port
;
12771 shmem_base
= shmem_base_path
[port
];
12772 shmem2_base
= shmem2_base_path
[port
];
12776 /* Extract the ext phy address for the port */
12777 if (bnx2x_populate_phy(bp
, phy_index
, shmem_base
, shmem2_base
,
12778 port_of_path
, &phy
[port
]) !=
12780 DP(NETIF_MSG_LINK
, "populate_phy failed\n");
12783 /* Disable attentions */
12784 bnx2x_bits_dis(bp
, NIG_REG_MASK_INTERRUPT_PORT0
+
12786 (NIG_MASK_XGXS0_LINK_STATUS
|
12787 NIG_MASK_XGXS0_LINK10G
|
12788 NIG_MASK_SERDES0_LINK_STATUS
|
12791 /* Need to take the phy out of low power mode in order
12792 * to write to access its registers
12794 bnx2x_set_gpio(bp
, MISC_REGISTERS_GPIO_2
,
12795 MISC_REGISTERS_GPIO_OUTPUT_HIGH
,
12798 /* Reset the phy */
12799 bnx2x_cl45_write(bp
, &phy
[port
],
12805 /* Add delay of 150ms after reset */
12808 if (phy
[PORT_0
].addr
& 0x1) {
12809 phy_blk
[PORT_0
] = &(phy
[PORT_1
]);
12810 phy_blk
[PORT_1
] = &(phy
[PORT_0
]);
12812 phy_blk
[PORT_0
] = &(phy
[PORT_0
]);
12813 phy_blk
[PORT_1
] = &(phy
[PORT_1
]);
12816 /* PART2 - Download firmware to both phys */
12817 for (port
= PORT_MAX
- 1; port
>= PORT_0
; port
--) {
12818 if (CHIP_IS_E1x(bp
))
12819 port_of_path
= port
;
12823 DP(NETIF_MSG_LINK
, "Loading spirom for phy address 0x%x\n",
12824 phy_blk
[port
]->addr
);
12825 if (bnx2x_8073_8727_external_rom_boot(bp
, phy_blk
[port
],
12829 /* Only set bit 10 = 1 (Tx power down) */
12830 bnx2x_cl45_read(bp
, phy_blk
[port
],
12832 MDIO_PMA_REG_TX_POWER_DOWN
, &val
);
12834 /* Phase1 of TX_POWER_DOWN reset */
12835 bnx2x_cl45_write(bp
, phy_blk
[port
],
12837 MDIO_PMA_REG_TX_POWER_DOWN
,
12841 /* Toggle Transmitter: Power down and then up with 600ms delay
12846 /* PART3 - complete TX_POWER_DOWN process, and set GPIO2 back to low */
12847 for (port
= PORT_MAX
- 1; port
>= PORT_0
; port
--) {
12848 /* Phase2 of POWER_DOWN_RESET */
12849 /* Release bit 10 (Release Tx power down) */
12850 bnx2x_cl45_read(bp
, phy_blk
[port
],
12852 MDIO_PMA_REG_TX_POWER_DOWN
, &val
);
12854 bnx2x_cl45_write(bp
, phy_blk
[port
],
12856 MDIO_PMA_REG_TX_POWER_DOWN
, (val
& (~(1<<10))));
12857 usleep_range(15000, 30000);
12859 /* Read modify write the SPI-ROM version select register */
12860 bnx2x_cl45_read(bp
, phy_blk
[port
],
12862 MDIO_PMA_REG_EDC_FFE_MAIN
, &val
);
12863 bnx2x_cl45_write(bp
, phy_blk
[port
],
12865 MDIO_PMA_REG_EDC_FFE_MAIN
, (val
| (1<<12)));
12867 /* set GPIO2 back to LOW */
12868 bnx2x_set_gpio(bp
, MISC_REGISTERS_GPIO_2
,
12869 MISC_REGISTERS_GPIO_OUTPUT_LOW
, port
);
12873 static int bnx2x_8726_common_init_phy(struct bnx2x
*bp
,
12874 u32 shmem_base_path
[],
12875 u32 shmem2_base_path
[], u8 phy_index
,
12880 struct bnx2x_phy phy
;
12881 /* Use port1 because of the static port-swap */
12882 /* Enable the module detection interrupt */
12883 val
= REG_RD(bp
, MISC_REG_GPIO_EVENT_EN
);
12884 val
|= ((1<<MISC_REGISTERS_GPIO_3
)|
12885 (1<<(MISC_REGISTERS_GPIO_3
+ MISC_REGISTERS_GPIO_PORT_SHIFT
)));
12886 REG_WR(bp
, MISC_REG_GPIO_EVENT_EN
, val
);
12888 bnx2x_ext_phy_hw_reset(bp
, 0);
12889 usleep_range(5000, 10000);
12890 for (port
= 0; port
< PORT_MAX
; port
++) {
12891 u32 shmem_base
, shmem2_base
;
12893 /* In E2, same phy is using for port0 of the two paths */
12894 if (CHIP_IS_E1x(bp
)) {
12895 shmem_base
= shmem_base_path
[0];
12896 shmem2_base
= shmem2_base_path
[0];
12898 shmem_base
= shmem_base_path
[port
];
12899 shmem2_base
= shmem2_base_path
[port
];
12901 /* Extract the ext phy address for the port */
12902 if (bnx2x_populate_phy(bp
, phy_index
, shmem_base
, shmem2_base
,
12905 DP(NETIF_MSG_LINK
, "populate phy failed\n");
12910 bnx2x_cl45_write(bp
, &phy
,
12911 MDIO_PMA_DEVAD
, MDIO_PMA_REG_GEN_CTRL
, 0x0001);
12914 /* Set fault module detected LED on */
12915 bnx2x_set_gpio(bp
, MISC_REGISTERS_GPIO_0
,
12916 MISC_REGISTERS_GPIO_HIGH
,
12922 static void bnx2x_get_ext_phy_reset_gpio(struct bnx2x
*bp
, u32 shmem_base
,
12923 u8
*io_gpio
, u8
*io_port
)
12926 u32 phy_gpio_reset
= REG_RD(bp
, shmem_base
+
12927 offsetof(struct shmem_region
,
12928 dev_info
.port_hw_config
[PORT_0
].default_cfg
));
12929 switch (phy_gpio_reset
) {
12930 case PORT_HW_CFG_EXT_PHY_GPIO_RST_GPIO0_P0
:
12934 case PORT_HW_CFG_EXT_PHY_GPIO_RST_GPIO1_P0
:
12938 case PORT_HW_CFG_EXT_PHY_GPIO_RST_GPIO2_P0
:
12942 case PORT_HW_CFG_EXT_PHY_GPIO_RST_GPIO3_P0
:
12946 case PORT_HW_CFG_EXT_PHY_GPIO_RST_GPIO0_P1
:
12950 case PORT_HW_CFG_EXT_PHY_GPIO_RST_GPIO1_P1
:
12954 case PORT_HW_CFG_EXT_PHY_GPIO_RST_GPIO2_P1
:
12958 case PORT_HW_CFG_EXT_PHY_GPIO_RST_GPIO3_P1
:
12963 /* Don't override the io_gpio and io_port */
12968 static int bnx2x_8727_common_init_phy(struct bnx2x
*bp
,
12969 u32 shmem_base_path
[],
12970 u32 shmem2_base_path
[], u8 phy_index
,
12973 s8 port
, reset_gpio
;
12974 u32 swap_val
, swap_override
;
12975 struct bnx2x_phy phy
[PORT_MAX
];
12976 struct bnx2x_phy
*phy_blk
[PORT_MAX
];
12978 swap_val
= REG_RD(bp
, NIG_REG_PORT_SWAP
);
12979 swap_override
= REG_RD(bp
, NIG_REG_STRAP_OVERRIDE
);
12981 reset_gpio
= MISC_REGISTERS_GPIO_1
;
12984 /* Retrieve the reset gpio/port which control the reset.
12985 * Default is GPIO1, PORT1
12987 bnx2x_get_ext_phy_reset_gpio(bp
, shmem_base_path
[0],
12988 (u8
*)&reset_gpio
, (u8
*)&port
);
12990 /* Calculate the port based on port swap */
12991 port
^= (swap_val
&& swap_override
);
12993 /* Initiate PHY reset*/
12994 bnx2x_set_gpio(bp
, reset_gpio
, MISC_REGISTERS_GPIO_OUTPUT_LOW
,
12996 usleep_range(1000, 2000);
12997 bnx2x_set_gpio(bp
, reset_gpio
, MISC_REGISTERS_GPIO_OUTPUT_HIGH
,
13000 usleep_range(5000, 10000);
13002 /* PART1 - Reset both phys */
13003 for (port
= PORT_MAX
- 1; port
>= PORT_0
; port
--) {
13004 u32 shmem_base
, shmem2_base
;
13006 /* In E2, same phy is using for port0 of the two paths */
13007 if (CHIP_IS_E1x(bp
)) {
13008 shmem_base
= shmem_base_path
[0];
13009 shmem2_base
= shmem2_base_path
[0];
13010 port_of_path
= port
;
13012 shmem_base
= shmem_base_path
[port
];
13013 shmem2_base
= shmem2_base_path
[port
];
13017 /* Extract the ext phy address for the port */
13018 if (bnx2x_populate_phy(bp
, phy_index
, shmem_base
, shmem2_base
,
13019 port_of_path
, &phy
[port
]) !=
13021 DP(NETIF_MSG_LINK
, "populate phy failed\n");
13024 /* disable attentions */
13025 bnx2x_bits_dis(bp
, NIG_REG_MASK_INTERRUPT_PORT0
+
13027 (NIG_MASK_XGXS0_LINK_STATUS
|
13028 NIG_MASK_XGXS0_LINK10G
|
13029 NIG_MASK_SERDES0_LINK_STATUS
|
13033 /* Reset the phy */
13034 bnx2x_cl45_write(bp
, &phy
[port
],
13035 MDIO_PMA_DEVAD
, MDIO_PMA_REG_CTRL
, 1<<15);
13038 /* Add delay of 150ms after reset */
13040 if (phy
[PORT_0
].addr
& 0x1) {
13041 phy_blk
[PORT_0
] = &(phy
[PORT_1
]);
13042 phy_blk
[PORT_1
] = &(phy
[PORT_0
]);
13044 phy_blk
[PORT_0
] = &(phy
[PORT_0
]);
13045 phy_blk
[PORT_1
] = &(phy
[PORT_1
]);
13047 /* PART2 - Download firmware to both phys */
13048 for (port
= PORT_MAX
- 1; port
>= PORT_0
; port
--) {
13049 if (CHIP_IS_E1x(bp
))
13050 port_of_path
= port
;
13053 DP(NETIF_MSG_LINK
, "Loading spirom for phy address 0x%x\n",
13054 phy_blk
[port
]->addr
);
13055 if (bnx2x_8073_8727_external_rom_boot(bp
, phy_blk
[port
],
13058 /* Disable PHY transmitter output */
13059 bnx2x_cl45_write(bp
, phy_blk
[port
],
13061 MDIO_PMA_REG_TX_DISABLE
, 1);
13067 static int bnx2x_84833_common_init_phy(struct bnx2x
*bp
,
13068 u32 shmem_base_path
[],
13069 u32 shmem2_base_path
[],
13074 reset_gpios
= bnx2x_84833_get_reset_gpios(bp
, shmem_base_path
, chip_id
);
13075 bnx2x_set_mult_gpio(bp
, reset_gpios
, MISC_REGISTERS_GPIO_OUTPUT_LOW
);
13077 bnx2x_set_mult_gpio(bp
, reset_gpios
, MISC_REGISTERS_GPIO_OUTPUT_HIGH
);
13078 DP(NETIF_MSG_LINK
, "84833 reset pulse on pin values 0x%x\n",
13083 static int bnx2x_ext_phy_common_init(struct bnx2x
*bp
, u32 shmem_base_path
[],
13084 u32 shmem2_base_path
[], u8 phy_index
,
13085 u32 ext_phy_type
, u32 chip_id
)
13089 switch (ext_phy_type
) {
13090 case PORT_HW_CFG_XGXS_EXT_PHY_TYPE_BCM8073
:
13091 rc
= bnx2x_8073_common_init_phy(bp
, shmem_base_path
,
13093 phy_index
, chip_id
);
13095 case PORT_HW_CFG_XGXS_EXT_PHY_TYPE_BCM8722
:
13096 case PORT_HW_CFG_XGXS_EXT_PHY_TYPE_BCM8727
:
13097 case PORT_HW_CFG_XGXS_EXT_PHY_TYPE_BCM8727_NOC
:
13098 rc
= bnx2x_8727_common_init_phy(bp
, shmem_base_path
,
13100 phy_index
, chip_id
);
13103 case PORT_HW_CFG_XGXS_EXT_PHY_TYPE_BCM8726
:
13104 /* GPIO1 affects both ports, so there's need to pull
13105 * it for single port alone
13107 rc
= bnx2x_8726_common_init_phy(bp
, shmem_base_path
,
13109 phy_index
, chip_id
);
13111 case PORT_HW_CFG_XGXS_EXT_PHY_TYPE_BCM84833
:
13112 case PORT_HW_CFG_XGXS_EXT_PHY_TYPE_BCM84834
:
13113 /* GPIO3's are linked, and so both need to be toggled
13114 * to obtain required 2us pulse.
13116 rc
= bnx2x_84833_common_init_phy(bp
, shmem_base_path
,
13118 phy_index
, chip_id
);
13120 case PORT_HW_CFG_XGXS_EXT_PHY_TYPE_FAILURE
:
13125 "ext_phy 0x%x common init not required\n",
13131 netdev_err(bp
->dev
, "Warning: PHY was not initialized,"
13137 int bnx2x_common_init_phy(struct bnx2x
*bp
, u32 shmem_base_path
[],
13138 u32 shmem2_base_path
[], u32 chip_id
)
13143 u32 ext_phy_type
, ext_phy_config
;
13145 bnx2x_set_mdio_clk(bp
, chip_id
, GRCBASE_EMAC0
);
13146 bnx2x_set_mdio_clk(bp
, chip_id
, GRCBASE_EMAC1
);
13147 DP(NETIF_MSG_LINK
, "Begin common phy init\n");
13148 if (CHIP_IS_E3(bp
)) {
13150 val
= REG_RD(bp
, MISC_REG_GEN_PURP_HWG
);
13151 REG_WR(bp
, MISC_REG_GEN_PURP_HWG
, val
| 1);
13153 /* Check if common init was already done */
13154 phy_ver
= REG_RD(bp
, shmem_base_path
[0] +
13155 offsetof(struct shmem_region
,
13156 port_mb
[PORT_0
].ext_phy_fw_version
));
13158 DP(NETIF_MSG_LINK
, "Not doing common init; phy ver is 0x%x\n",
13163 /* Read the ext_phy_type for arbitrary port(0) */
13164 for (phy_index
= EXT_PHY1
; phy_index
< MAX_PHYS
;
13166 ext_phy_config
= bnx2x_get_ext_phy_config(bp
,
13167 shmem_base_path
[0],
13169 ext_phy_type
= XGXS_EXT_PHY_TYPE(ext_phy_config
);
13170 rc
|= bnx2x_ext_phy_common_init(bp
, shmem_base_path
,
13172 phy_index
, ext_phy_type
,
13178 static void bnx2x_check_over_curr(struct link_params
*params
,
13179 struct link_vars
*vars
)
13181 struct bnx2x
*bp
= params
->bp
;
13183 u8 port
= params
->port
;
13186 cfg_pin
= (REG_RD(bp
, params
->shmem_base
+
13187 offsetof(struct shmem_region
,
13188 dev_info
.port_hw_config
[port
].e3_cmn_pin_cfg1
)) &
13189 PORT_HW_CFG_E3_OVER_CURRENT_MASK
) >>
13190 PORT_HW_CFG_E3_OVER_CURRENT_SHIFT
;
13192 /* Ignore check if no external input PIN available */
13193 if (bnx2x_get_cfg_pin(bp
, cfg_pin
, &pin_val
) != 0)
13197 if ((vars
->phy_flags
& PHY_OVER_CURRENT_FLAG
) == 0) {
13198 netdev_err(bp
->dev
, "Error: Power fault on Port %d has"
13199 " been detected and the power to "
13200 "that SFP+ module has been removed"
13201 " to prevent failure of the card."
13202 " Please remove the SFP+ module and"
13203 " restart the system to clear this"
13206 vars
->phy_flags
|= PHY_OVER_CURRENT_FLAG
;
13207 bnx2x_warpcore_power_module(params
, 0);
13210 vars
->phy_flags
&= ~PHY_OVER_CURRENT_FLAG
;
13213 /* Returns 0 if no change occured since last check; 1 otherwise. */
13214 static u8
bnx2x_analyze_link_error(struct link_params
*params
,
13215 struct link_vars
*vars
, u32 status
,
13216 u32 phy_flag
, u32 link_flag
, u8 notify
)
13218 struct bnx2x
*bp
= params
->bp
;
13219 /* Compare new value with previous value */
13221 u32 old_status
= (vars
->phy_flags
& phy_flag
) ? 1 : 0;
13223 if ((status
^ old_status
) == 0)
13226 /* If values differ */
13227 switch (phy_flag
) {
13228 case PHY_HALF_OPEN_CONN_FLAG
:
13229 DP(NETIF_MSG_LINK
, "Analyze Remote Fault\n");
13231 case PHY_SFP_TX_FAULT_FLAG
:
13232 DP(NETIF_MSG_LINK
, "Analyze TX Fault\n");
13235 DP(NETIF_MSG_LINK
, "Analyze UNKNOWN\n");
13237 DP(NETIF_MSG_LINK
, "Link changed:[%x %x]->%x\n", vars
->link_up
,
13238 old_status
, status
);
13240 /* a. Update shmem->link_status accordingly
13241 * b. Update link_vars->link_up
13244 vars
->link_status
&= ~LINK_STATUS_LINK_UP
;
13245 vars
->link_status
|= link_flag
;
13247 vars
->phy_flags
|= phy_flag
;
13249 /* activate nig drain */
13250 REG_WR(bp
, NIG_REG_EGRESS_DRAIN0_MODE
+ params
->port
*4, 1);
13251 /* Set LED mode to off since the PHY doesn't know about these
13254 led_mode
= LED_MODE_OFF
;
13256 vars
->link_status
|= LINK_STATUS_LINK_UP
;
13257 vars
->link_status
&= ~link_flag
;
13259 vars
->phy_flags
&= ~phy_flag
;
13260 led_mode
= LED_MODE_OPER
;
13262 /* Clear nig drain */
13263 REG_WR(bp
, NIG_REG_EGRESS_DRAIN0_MODE
+ params
->port
*4, 0);
13265 bnx2x_sync_link(params
, vars
);
13266 /* Update the LED according to the link state */
13267 bnx2x_set_led(params
, vars
, led_mode
, SPEED_10000
);
13269 /* Update link status in the shared memory */
13270 bnx2x_update_mng(params
, vars
->link_status
);
13272 /* C. Trigger General Attention */
13273 vars
->periodic_flags
|= PERIODIC_FLAGS_LINK_EVENT
;
13275 bnx2x_notify_link_changed(bp
);
13280 /******************************************************************************
13282 * This function checks for half opened connection change indication.
13283 * When such change occurs, it calls the bnx2x_analyze_link_error
13284 * to check if Remote Fault is set or cleared. Reception of remote fault
13285 * status message in the MAC indicates that the peer's MAC has detected
13286 * a fault, for example, due to break in the TX side of fiber.
13288 ******************************************************************************/
13289 int bnx2x_check_half_open_conn(struct link_params
*params
,
13290 struct link_vars
*vars
,
13293 struct bnx2x
*bp
= params
->bp
;
13294 u32 lss_status
= 0;
13296 /* In case link status is physically up @ 10G do */
13297 if (((vars
->phy_flags
& PHY_PHYSICAL_LINK_FLAG
) == 0) ||
13298 (REG_RD(bp
, NIG_REG_EGRESS_EMAC0_PORT
+ params
->port
*4)))
13301 if (CHIP_IS_E3(bp
) &&
13302 (REG_RD(bp
, MISC_REG_RESET_REG_2
) &
13303 (MISC_REGISTERS_RESET_REG_2_XMAC
))) {
13304 /* Check E3 XMAC */
13305 /* Note that link speed cannot be queried here, since it may be
13306 * zero while link is down. In case UMAC is active, LSS will
13307 * simply not be set
13309 mac_base
= (params
->port
) ? GRCBASE_XMAC1
: GRCBASE_XMAC0
;
13311 /* Clear stick bits (Requires rising edge) */
13312 REG_WR(bp
, mac_base
+ XMAC_REG_CLEAR_RX_LSS_STATUS
, 0);
13313 REG_WR(bp
, mac_base
+ XMAC_REG_CLEAR_RX_LSS_STATUS
,
13314 XMAC_CLEAR_RX_LSS_STATUS_REG_CLEAR_LOCAL_FAULT_STATUS
|
13315 XMAC_CLEAR_RX_LSS_STATUS_REG_CLEAR_REMOTE_FAULT_STATUS
);
13316 if (REG_RD(bp
, mac_base
+ XMAC_REG_RX_LSS_STATUS
))
13319 bnx2x_analyze_link_error(params
, vars
, lss_status
,
13320 PHY_HALF_OPEN_CONN_FLAG
,
13321 LINK_STATUS_NONE
, notify
);
13322 } else if (REG_RD(bp
, MISC_REG_RESET_REG_2
) &
13323 (MISC_REGISTERS_RESET_REG_2_RST_BMAC0
<< params
->port
)) {
13324 /* Check E1X / E2 BMAC */
13325 u32 lss_status_reg
;
13327 mac_base
= params
->port
? NIG_REG_INGRESS_BMAC1_MEM
:
13328 NIG_REG_INGRESS_BMAC0_MEM
;
13329 /* Read BIGMAC_REGISTER_RX_LSS_STATUS */
13330 if (CHIP_IS_E2(bp
))
13331 lss_status_reg
= BIGMAC2_REGISTER_RX_LSS_STAT
;
13333 lss_status_reg
= BIGMAC_REGISTER_RX_LSS_STATUS
;
13335 REG_RD_DMAE(bp
, mac_base
+ lss_status_reg
, wb_data
, 2);
13336 lss_status
= (wb_data
[0] > 0);
13338 bnx2x_analyze_link_error(params
, vars
, lss_status
,
13339 PHY_HALF_OPEN_CONN_FLAG
,
13340 LINK_STATUS_NONE
, notify
);
13344 static void bnx2x_sfp_tx_fault_detection(struct bnx2x_phy
*phy
,
13345 struct link_params
*params
,
13346 struct link_vars
*vars
)
13348 struct bnx2x
*bp
= params
->bp
;
13349 u32 cfg_pin
, value
= 0;
13350 u8 led_change
, port
= params
->port
;
13352 /* Get The SFP+ TX_Fault controlling pin ([eg]pio) */
13353 cfg_pin
= (REG_RD(bp
, params
->shmem_base
+ offsetof(struct shmem_region
,
13354 dev_info
.port_hw_config
[port
].e3_cmn_pin_cfg
)) &
13355 PORT_HW_CFG_E3_TX_FAULT_MASK
) >>
13356 PORT_HW_CFG_E3_TX_FAULT_SHIFT
;
13358 if (bnx2x_get_cfg_pin(bp
, cfg_pin
, &value
)) {
13359 DP(NETIF_MSG_LINK
, "Failed to read pin 0x%02x\n", cfg_pin
);
13363 led_change
= bnx2x_analyze_link_error(params
, vars
, value
,
13364 PHY_SFP_TX_FAULT_FLAG
,
13365 LINK_STATUS_SFP_TX_FAULT
, 1);
13368 /* Change TX_Fault led, set link status for further syncs */
13371 if (vars
->phy_flags
& PHY_SFP_TX_FAULT_FLAG
) {
13372 led_mode
= MISC_REGISTERS_GPIO_HIGH
;
13373 vars
->link_status
|= LINK_STATUS_SFP_TX_FAULT
;
13375 led_mode
= MISC_REGISTERS_GPIO_LOW
;
13376 vars
->link_status
&= ~LINK_STATUS_SFP_TX_FAULT
;
13379 /* If module is unapproved, led should be on regardless */
13380 if (!(phy
->flags
& FLAGS_SFP_NOT_APPROVED
)) {
13381 DP(NETIF_MSG_LINK
, "Change TX_Fault LED: ->%x\n",
13383 bnx2x_set_e3_module_fault_led(params
, led_mode
);
13387 static void bnx2x_disable_kr2(struct link_params
*params
,
13388 struct link_vars
*vars
,
13389 struct bnx2x_phy
*phy
)
13391 struct bnx2x
*bp
= params
->bp
;
13393 static struct bnx2x_reg_set reg_set
[] = {
13394 /* Step 1 - Program the TX/RX alignment markers */
13395 {MDIO_WC_DEVAD
, MDIO_WC_REG_CL82_USERB1_TX_CTRL5
, 0x7690},
13396 {MDIO_WC_DEVAD
, MDIO_WC_REG_CL82_USERB1_TX_CTRL7
, 0xe647},
13397 {MDIO_WC_DEVAD
, MDIO_WC_REG_CL82_USERB1_TX_CTRL6
, 0xc4f0},
13398 {MDIO_WC_DEVAD
, MDIO_WC_REG_CL82_USERB1_TX_CTRL9
, 0x7690},
13399 {MDIO_WC_DEVAD
, MDIO_WC_REG_CL82_USERB1_RX_CTRL11
, 0xe647},
13400 {MDIO_WC_DEVAD
, MDIO_WC_REG_CL82_USERB1_RX_CTRL10
, 0xc4f0},
13401 {MDIO_WC_DEVAD
, MDIO_WC_REG_CL73_USERB0_CTRL
, 0x000c},
13402 {MDIO_WC_DEVAD
, MDIO_WC_REG_CL73_BAM_CTRL1
, 0x6000},
13403 {MDIO_WC_DEVAD
, MDIO_WC_REG_CL73_BAM_CTRL3
, 0x0000},
13404 {MDIO_WC_DEVAD
, MDIO_WC_REG_CL73_BAM_CODE_FIELD
, 0x0002},
13405 {MDIO_WC_DEVAD
, MDIO_WC_REG_ETA_CL73_OUI1
, 0x0000},
13406 {MDIO_WC_DEVAD
, MDIO_WC_REG_ETA_CL73_OUI2
, 0x0af7},
13407 {MDIO_WC_DEVAD
, MDIO_WC_REG_ETA_CL73_OUI3
, 0x0af7},
13408 {MDIO_WC_DEVAD
, MDIO_WC_REG_ETA_CL73_LD_BAM_CODE
, 0x0002},
13409 {MDIO_WC_DEVAD
, MDIO_WC_REG_ETA_CL73_LD_UD_CODE
, 0x0000}
13411 DP(NETIF_MSG_LINK
, "Disabling 20G-KR2\n");
13413 for (i
= 0; i
< ARRAY_SIZE(reg_set
); i
++)
13414 bnx2x_cl45_write(bp
, phy
, reg_set
[i
].devad
, reg_set
[i
].reg
,
13416 vars
->link_attr_sync
&= ~LINK_ATTR_SYNC_KR2_ENABLE
;
13417 bnx2x_update_link_attr(params
, vars
->link_attr_sync
);
13419 vars
->check_kr2_recovery_cnt
= CHECK_KR2_RECOVERY_CNT
;
13420 /* Restart AN on leading lane */
13421 bnx2x_warpcore_restart_AN_KR(phy
, params
);
13424 static void bnx2x_kr2_recovery(struct link_params
*params
,
13425 struct link_vars
*vars
,
13426 struct bnx2x_phy
*phy
)
13428 struct bnx2x
*bp
= params
->bp
;
13429 DP(NETIF_MSG_LINK
, "KR2 recovery\n");
13430 bnx2x_warpcore_enable_AN_KR2(phy
, params
, vars
);
13431 bnx2x_warpcore_restart_AN_KR(phy
, params
);
13434 static void bnx2x_check_kr2_wa(struct link_params
*params
,
13435 struct link_vars
*vars
,
13436 struct bnx2x_phy
*phy
)
13438 struct bnx2x
*bp
= params
->bp
;
13439 u16 base_page
, next_page
, not_kr2_device
, lane
;
13442 /* Once KR2 was disabled, wait 5 seconds before checking KR2 recovery
13443 * since some switches tend to reinit the AN process and clear the
13444 * advertised BP/NP after ~2 seconds causing the KR2 to be disabled
13445 * and recovered many times
13447 if (vars
->check_kr2_recovery_cnt
> 0) {
13448 vars
->check_kr2_recovery_cnt
--;
13452 sigdet
= bnx2x_warpcore_get_sigdet(phy
, params
);
13454 if (!(vars
->link_attr_sync
& LINK_ATTR_SYNC_KR2_ENABLE
)) {
13455 bnx2x_kr2_recovery(params
, vars
, phy
);
13456 DP(NETIF_MSG_LINK
, "No sigdet\n");
13461 lane
= bnx2x_get_warpcore_lane(phy
, params
);
13462 CL22_WR_OVER_CL45(bp
, phy
, MDIO_REG_BANK_AER_BLOCK
,
13463 MDIO_AER_BLOCK_AER_REG
, lane
);
13464 bnx2x_cl45_read(bp
, phy
, MDIO_AN_DEVAD
,
13465 MDIO_AN_REG_LP_AUTO_NEG
, &base_page
);
13466 bnx2x_cl45_read(bp
, phy
, MDIO_AN_DEVAD
,
13467 MDIO_AN_REG_LP_AUTO_NEG2
, &next_page
);
13468 bnx2x_set_aer_mmd(params
, phy
);
13470 /* CL73 has not begun yet */
13471 if (base_page
== 0) {
13472 if (!(vars
->link_attr_sync
& LINK_ATTR_SYNC_KR2_ENABLE
))
13473 bnx2x_kr2_recovery(params
, vars
, phy
);
13477 /* In case NP bit is not set in the BasePage, or it is set,
13478 * but only KX is advertised, declare this link partner as non-KR2
13481 not_kr2_device
= (((base_page
& 0x8000) == 0) ||
13482 (((base_page
& 0x8000) &&
13483 ((next_page
& 0xe0) == 0x2))));
13485 /* In case KR2 is already disabled, check if we need to re-enable it */
13486 if (!(vars
->link_attr_sync
& LINK_ATTR_SYNC_KR2_ENABLE
)) {
13487 if (!not_kr2_device
) {
13488 DP(NETIF_MSG_LINK
, "BP=0x%x, NP=0x%x\n", base_page
,
13490 bnx2x_kr2_recovery(params
, vars
, phy
);
13494 /* KR2 is enabled, but not KR2 device */
13495 if (not_kr2_device
) {
13496 /* Disable KR2 on both lanes */
13497 DP(NETIF_MSG_LINK
, "BP=0x%x, NP=0x%x\n", base_page
, next_page
);
13498 bnx2x_disable_kr2(params
, vars
, phy
);
13503 void bnx2x_period_func(struct link_params
*params
, struct link_vars
*vars
)
13506 struct bnx2x
*bp
= params
->bp
;
13507 for (phy_idx
= INT_PHY
; phy_idx
< MAX_PHYS
; phy_idx
++) {
13508 if (params
->phy
[phy_idx
].flags
& FLAGS_TX_ERROR_CHECK
) {
13509 bnx2x_set_aer_mmd(params
, ¶ms
->phy
[phy_idx
]);
13510 if (bnx2x_check_half_open_conn(params
, vars
, 1) !=
13512 DP(NETIF_MSG_LINK
, "Fault detection failed\n");
13517 if (CHIP_IS_E3(bp
)) {
13518 struct bnx2x_phy
*phy
= ¶ms
->phy
[INT_PHY
];
13519 bnx2x_set_aer_mmd(params
, phy
);
13520 if ((phy
->supported
& SUPPORTED_20000baseKR2_Full
) &&
13521 (phy
->speed_cap_mask
& PORT_HW_CFG_SPEED_CAPABILITY_D0_20G
))
13522 bnx2x_check_kr2_wa(params
, vars
, phy
);
13523 bnx2x_check_over_curr(params
, vars
);
13524 if (vars
->rx_tx_asic_rst
)
13525 bnx2x_warpcore_config_runtime(phy
, params
, vars
);
13527 if ((REG_RD(bp
, params
->shmem_base
+
13528 offsetof(struct shmem_region
, dev_info
.
13529 port_hw_config
[params
->port
].default_cfg
))
13530 & PORT_HW_CFG_NET_SERDES_IF_MASK
) ==
13531 PORT_HW_CFG_NET_SERDES_IF_SFI
) {
13532 if (bnx2x_is_sfp_module_plugged(phy
, params
)) {
13533 bnx2x_sfp_tx_fault_detection(phy
, params
, vars
);
13534 } else if (vars
->link_status
&
13535 LINK_STATUS_SFP_TX_FAULT
) {
13536 /* Clean trail, interrupt corrects the leds */
13537 vars
->link_status
&= ~LINK_STATUS_SFP_TX_FAULT
;
13538 vars
->phy_flags
&= ~PHY_SFP_TX_FAULT_FLAG
;
13539 /* Update link status in the shared memory */
13540 bnx2x_update_mng(params
, vars
->link_status
);
13546 u8
bnx2x_fan_failure_det_req(struct bnx2x
*bp
,
13551 u8 phy_index
, fan_failure_det_req
= 0;
13552 struct bnx2x_phy phy
;
13553 for (phy_index
= EXT_PHY1
; phy_index
< MAX_PHYS
;
13555 if (bnx2x_populate_phy(bp
, phy_index
, shmem_base
, shmem2_base
,
13558 DP(NETIF_MSG_LINK
, "populate phy failed\n");
13561 fan_failure_det_req
|= (phy
.flags
&
13562 FLAGS_FAN_FAILURE_DET_REQ
);
13564 return fan_failure_det_req
;
13567 void bnx2x_hw_reset_phy(struct link_params
*params
)
13570 struct bnx2x
*bp
= params
->bp
;
13571 bnx2x_update_mng(params
, 0);
13572 bnx2x_bits_dis(bp
, NIG_REG_MASK_INTERRUPT_PORT0
+ params
->port
*4,
13573 (NIG_MASK_XGXS0_LINK_STATUS
|
13574 NIG_MASK_XGXS0_LINK10G
|
13575 NIG_MASK_SERDES0_LINK_STATUS
|
13578 for (phy_index
= INT_PHY
; phy_index
< MAX_PHYS
;
13580 if (params
->phy
[phy_index
].hw_reset
) {
13581 params
->phy
[phy_index
].hw_reset(
13582 ¶ms
->phy
[phy_index
],
13584 params
->phy
[phy_index
] = phy_null
;
13589 void bnx2x_init_mod_abs_int(struct bnx2x
*bp
, struct link_vars
*vars
,
13590 u32 chip_id
, u32 shmem_base
, u32 shmem2_base
,
13593 u8 gpio_num
= 0xff, gpio_port
= 0xff, phy_index
;
13595 u32 offset
, aeu_mask
, swap_val
, swap_override
, sync_offset
;
13596 if (CHIP_IS_E3(bp
)) {
13597 if (bnx2x_get_mod_abs_int_cfg(bp
, chip_id
,
13604 struct bnx2x_phy phy
;
13605 for (phy_index
= EXT_PHY1
; phy_index
< MAX_PHYS
;
13607 if (bnx2x_populate_phy(bp
, phy_index
, shmem_base
,
13608 shmem2_base
, port
, &phy
)
13610 DP(NETIF_MSG_LINK
, "populate phy failed\n");
13613 if (phy
.type
== PORT_HW_CFG_XGXS_EXT_PHY_TYPE_BCM8726
) {
13614 gpio_num
= MISC_REGISTERS_GPIO_3
;
13621 if (gpio_num
== 0xff)
13624 /* Set GPIO3 to trigger SFP+ module insertion/removal */
13625 bnx2x_set_gpio(bp
, gpio_num
, MISC_REGISTERS_GPIO_INPUT_HI_Z
, gpio_port
);
13627 swap_val
= REG_RD(bp
, NIG_REG_PORT_SWAP
);
13628 swap_override
= REG_RD(bp
, NIG_REG_STRAP_OVERRIDE
);
13629 gpio_port
^= (swap_val
&& swap_override
);
13631 vars
->aeu_int_mask
= AEU_INPUTS_ATTN_BITS_GPIO0_FUNCTION_0
<<
13632 (gpio_num
+ (gpio_port
<< 2));
13634 sync_offset
= shmem_base
+
13635 offsetof(struct shmem_region
,
13636 dev_info
.port_hw_config
[port
].aeu_int_mask
);
13637 REG_WR(bp
, sync_offset
, vars
->aeu_int_mask
);
13639 DP(NETIF_MSG_LINK
, "Setting MOD_ABS (GPIO%d_P%d) AEU to 0x%x\n",
13640 gpio_num
, gpio_port
, vars
->aeu_int_mask
);
13643 offset
= MISC_REG_AEU_ENABLE1_FUNC_0_OUT_0
;
13645 offset
= MISC_REG_AEU_ENABLE1_FUNC_1_OUT_0
;
13647 /* Open appropriate AEU for interrupts */
13648 aeu_mask
= REG_RD(bp
, offset
);
13649 aeu_mask
|= vars
->aeu_int_mask
;
13650 REG_WR(bp
, offset
, aeu_mask
);
13652 /* Enable the GPIO to trigger interrupt */
13653 val
= REG_RD(bp
, MISC_REG_GPIO_EVENT_EN
);
13654 val
|= 1 << (gpio_num
+ (gpio_port
<< 2));
13655 REG_WR(bp
, MISC_REG_GPIO_EVENT_EN
, val
);