1 // SPDX-License-Identifier: GPL-2.0
2 /* Marvell CN10K RPM driver
4 * Copyright (C) 2020 Marvell.
9 #include "lmac_common.h"
11 static struct mac_ops rpm_mac_ops
= {
15 .int_register
= RPMX_CMRX_SW_INT
,
16 .int_set_reg
= RPMX_CMRX_SW_INT_ENA_W1S
,
18 .int_ena_bit
= BIT_ULL(0),
19 .lmac_fwi
= RPM_LMAC_FWI
,
20 .non_contiguous_serdes_lane
= true,
23 .get_nr_lmacs
= rpm_get_nr_lmacs
,
24 .get_lmac_type
= rpm_get_lmac_type
,
25 .mac_lmac_intl_lbk
= rpm_lmac_internal_loopback
,
26 .mac_get_rx_stats
= rpm_get_rx_stats
,
27 .mac_get_tx_stats
= rpm_get_tx_stats
,
28 .mac_enadis_rx_pause_fwding
= rpm_lmac_enadis_rx_pause_fwding
,
29 .mac_get_pause_frm_status
= rpm_lmac_get_pause_frm_status
,
30 .mac_enadis_pause_frm
= rpm_lmac_enadis_pause_frm
,
31 .mac_pause_frm_config
= rpm_lmac_pause_frm_config
,
34 struct mac_ops
*rpm_get_mac_ops(void)
39 static void rpm_write(rpm_t
*rpm
, u64 lmac
, u64 offset
, u64 val
)
41 cgx_write(rpm
, lmac
, offset
, val
);
44 static u64
rpm_read(rpm_t
*rpm
, u64 lmac
, u64 offset
)
46 return cgx_read(rpm
, lmac
, offset
);
49 int rpm_get_nr_lmacs(void *rpmd
)
53 return hweight8(rpm_read(rpm
, 0, CGXX_CMRX_RX_LMACS
) & 0xFULL
);
56 void rpm_lmac_enadis_rx_pause_fwding(void *rpmd
, int lmac_id
, bool enable
)
65 cfg
= rpm_read(rpm
, lmac_id
, RPMX_MTI_MAC100X_COMMAND_CONFIG
);
66 cfg
&= ~RPMX_MTI_MAC100X_COMMAND_CONFIG_PAUSE_IGNORE
;
67 rpm_write(rpm
, lmac_id
, RPMX_MTI_MAC100X_COMMAND_CONFIG
, cfg
);
69 cfg
= rpm_read(rpm
, lmac_id
, RPMX_MTI_MAC100X_COMMAND_CONFIG
);
70 cfg
|= RPMX_MTI_MAC100X_COMMAND_CONFIG_PAUSE_IGNORE
;
71 rpm_write(rpm
, lmac_id
, RPMX_MTI_MAC100X_COMMAND_CONFIG
, cfg
);
75 int rpm_lmac_get_pause_frm_status(void *rpmd
, int lmac_id
,
76 u8
*tx_pause
, u8
*rx_pause
)
81 if (!is_lmac_valid(rpm
, lmac_id
))
84 cfg
= rpm_read(rpm
, lmac_id
, RPMX_MTI_MAC100X_COMMAND_CONFIG
);
85 *rx_pause
= !(cfg
& RPMX_MTI_MAC100X_COMMAND_CONFIG_RX_P_DISABLE
);
87 cfg
= rpm_read(rpm
, lmac_id
, RPMX_MTI_MAC100X_COMMAND_CONFIG
);
88 *tx_pause
= !(cfg
& RPMX_MTI_MAC100X_COMMAND_CONFIG_TX_P_DISABLE
);
92 int rpm_lmac_enadis_pause_frm(void *rpmd
, int lmac_id
, u8 tx_pause
,
98 if (!is_lmac_valid(rpm
, lmac_id
))
101 cfg
= rpm_read(rpm
, lmac_id
, RPMX_MTI_MAC100X_COMMAND_CONFIG
);
102 cfg
&= ~RPMX_MTI_MAC100X_COMMAND_CONFIG_RX_P_DISABLE
;
103 cfg
|= rx_pause
? 0x0 : RPMX_MTI_MAC100X_COMMAND_CONFIG_RX_P_DISABLE
;
104 cfg
&= ~RPMX_MTI_MAC100X_COMMAND_CONFIG_PAUSE_IGNORE
;
105 cfg
|= rx_pause
? 0x0 : RPMX_MTI_MAC100X_COMMAND_CONFIG_PAUSE_IGNORE
;
106 rpm_write(rpm
, lmac_id
, RPMX_MTI_MAC100X_COMMAND_CONFIG
, cfg
);
108 cfg
= rpm_read(rpm
, lmac_id
, RPMX_MTI_MAC100X_COMMAND_CONFIG
);
109 cfg
&= ~RPMX_MTI_MAC100X_COMMAND_CONFIG_TX_P_DISABLE
;
110 cfg
|= tx_pause
? 0x0 : RPMX_MTI_MAC100X_COMMAND_CONFIG_TX_P_DISABLE
;
111 rpm_write(rpm
, lmac_id
, RPMX_MTI_MAC100X_COMMAND_CONFIG
, cfg
);
113 cfg
= rpm_read(rpm
, 0, RPMX_CMR_RX_OVR_BP
);
115 cfg
&= ~RPMX_CMR_RX_OVR_BP_EN(lmac_id
);
117 cfg
|= RPMX_CMR_RX_OVR_BP_EN(lmac_id
);
118 cfg
&= ~RPMX_CMR_RX_OVR_BP_BP(lmac_id
);
120 rpm_write(rpm
, 0, RPMX_CMR_RX_OVR_BP
, cfg
);
124 void rpm_lmac_pause_frm_config(void *rpmd
, int lmac_id
, bool enable
)
130 /* Enable 802.3 pause frame mode */
131 cfg
= rpm_read(rpm
, lmac_id
, RPMX_MTI_MAC100X_COMMAND_CONFIG
);
132 cfg
&= ~RPMX_MTI_MAC100X_COMMAND_CONFIG_PFC_MODE
;
133 rpm_write(rpm
, lmac_id
, RPMX_MTI_MAC100X_COMMAND_CONFIG
, cfg
);
135 /* Enable receive pause frames */
136 cfg
= rpm_read(rpm
, lmac_id
, RPMX_MTI_MAC100X_COMMAND_CONFIG
);
137 cfg
&= ~RPMX_MTI_MAC100X_COMMAND_CONFIG_RX_P_DISABLE
;
138 rpm_write(rpm
, lmac_id
, RPMX_MTI_MAC100X_COMMAND_CONFIG
, cfg
);
140 /* Enable forward pause to TX block */
141 cfg
= rpm_read(rpm
, lmac_id
, RPMX_MTI_MAC100X_COMMAND_CONFIG
);
142 cfg
&= ~RPMX_MTI_MAC100X_COMMAND_CONFIG_PAUSE_IGNORE
;
143 rpm_write(rpm
, lmac_id
, RPMX_MTI_MAC100X_COMMAND_CONFIG
, cfg
);
145 /* Enable pause frames transmission */
146 cfg
= rpm_read(rpm
, lmac_id
, RPMX_MTI_MAC100X_COMMAND_CONFIG
);
147 cfg
&= ~RPMX_MTI_MAC100X_COMMAND_CONFIG_TX_P_DISABLE
;
148 rpm_write(rpm
, lmac_id
, RPMX_MTI_MAC100X_COMMAND_CONFIG
, cfg
);
150 /* Set pause time and interval */
151 cfg
= rpm_read(rpm
, lmac_id
,
152 RPMX_MTI_MAC100X_CL01_PAUSE_QUANTA
);
154 rpm_write(rpm
, lmac_id
, RPMX_MTI_MAC100X_CL01_PAUSE_QUANTA
,
155 cfg
| RPM_DEFAULT_PAUSE_TIME
);
156 /* Set pause interval as the hardware default is too short */
157 cfg
= rpm_read(rpm
, lmac_id
,
158 RPMX_MTI_MAC100X_CL01_QUANTA_THRESH
);
160 rpm_write(rpm
, lmac_id
, RPMX_MTI_MAC100X_CL01_QUANTA_THRESH
,
161 cfg
| (RPM_DEFAULT_PAUSE_TIME
/ 2));
164 /* ALL pause frames received are completely ignored */
165 cfg
= rpm_read(rpm
, lmac_id
, RPMX_MTI_MAC100X_COMMAND_CONFIG
);
166 cfg
|= RPMX_MTI_MAC100X_COMMAND_CONFIG_RX_P_DISABLE
;
167 rpm_write(rpm
, lmac_id
, RPMX_MTI_MAC100X_COMMAND_CONFIG
, cfg
);
169 /* Disable forward pause to TX block */
170 cfg
= rpm_read(rpm
, lmac_id
, RPMX_MTI_MAC100X_COMMAND_CONFIG
);
171 cfg
|= RPMX_MTI_MAC100X_COMMAND_CONFIG_PAUSE_IGNORE
;
172 rpm_write(rpm
, lmac_id
, RPMX_MTI_MAC100X_COMMAND_CONFIG
, cfg
);
174 /* Disable pause frames transmission */
175 cfg
= rpm_read(rpm
, lmac_id
, RPMX_MTI_MAC100X_COMMAND_CONFIG
);
176 cfg
|= RPMX_MTI_MAC100X_COMMAND_CONFIG_TX_P_DISABLE
;
177 rpm_write(rpm
, lmac_id
, RPMX_MTI_MAC100X_COMMAND_CONFIG
, cfg
);
181 int rpm_get_rx_stats(void *rpmd
, int lmac_id
, int idx
, u64
*rx_stat
)
186 if (!rpm
|| lmac_id
>= rpm
->lmac_count
)
189 mutex_lock(&rpm
->lock
);
191 /* Update idx to point per lmac Rx statistics page */
192 idx
+= lmac_id
* rpm
->mac_ops
->rx_stats_cnt
;
194 /* Read lower 32 bits of counter */
195 val_lo
= rpm_read(rpm
, 0, RPMX_MTI_STAT_RX_STAT_PAGES_COUNTERX
+
198 /* upon read of lower 32 bits, higher 32 bits are written
199 * to RPMX_MTI_STAT_DATA_HI_CDC
201 val_hi
= rpm_read(rpm
, 0, RPMX_MTI_STAT_DATA_HI_CDC
);
203 *rx_stat
= (val_hi
<< 32 | val_lo
);
205 mutex_unlock(&rpm
->lock
);
209 int rpm_get_tx_stats(void *rpmd
, int lmac_id
, int idx
, u64
*tx_stat
)
214 if (!rpm
|| lmac_id
>= rpm
->lmac_count
)
217 mutex_lock(&rpm
->lock
);
219 /* Update idx to point per lmac Tx statistics page */
220 idx
+= lmac_id
* rpm
->mac_ops
->tx_stats_cnt
;
222 val_lo
= rpm_read(rpm
, 0, RPMX_MTI_STAT_TX_STAT_PAGES_COUNTERX
+
224 val_hi
= rpm_read(rpm
, 0, RPMX_MTI_STAT_DATA_HI_CDC
);
226 *tx_stat
= (val_hi
<< 32 | val_lo
);
228 mutex_unlock(&rpm
->lock
);
232 u8
rpm_get_lmac_type(void *rpmd
, int lmac_id
)
238 req
= FIELD_SET(CMDREG_ID
, CGX_CMD_GET_LINK_STS
, req
);
239 err
= cgx_fwi_cmd_generic(req
, &resp
, rpm
, 0);
241 return FIELD_GET(RESP_LINKSTAT_LMAC_TYPE
, resp
);
245 int rpm_lmac_internal_loopback(void *rpmd
, int lmac_id
, bool enable
)
251 if (!rpm
|| lmac_id
>= rpm
->lmac_count
)
253 lmac_type
= rpm
->mac_ops
->get_lmac_type(rpm
, lmac_id
);
254 if (lmac_type
== LMAC_MODE_100G_R
) {
255 cfg
= rpm_read(rpm
, lmac_id
, RPMX_MTI_PCS100X_CONTROL1
);
258 cfg
|= RPMX_MTI_PCS_LBK
;
260 cfg
&= ~RPMX_MTI_PCS_LBK
;
261 rpm_write(rpm
, lmac_id
, RPMX_MTI_PCS100X_CONTROL1
, cfg
);
263 cfg
= rpm_read(rpm
, lmac_id
, RPMX_MTI_LPCSX_CONTROL1
);
265 cfg
|= RPMX_MTI_PCS_LBK
;
267 cfg
&= ~RPMX_MTI_PCS_LBK
;
268 rpm_write(rpm
, lmac_id
, RPMX_MTI_LPCSX_CONTROL1
, cfg
);