65 	u64 cfg, last;  in rpm_lmac_tx_enable()  local
70 	cfg = rpm_read(rpm, lmac_id, RPMX_MTI_MAC100X_COMMAND_CONFIG);  in rpm_lmac_tx_enable()
71 	last = cfg;  in rpm_lmac_tx_enable()
73 		cfg |= RPM_TX_EN;  in rpm_lmac_tx_enable()
75 		cfg &= ~(RPM_TX_EN);  in rpm_lmac_tx_enable()
77 	if (cfg != last)  in rpm_lmac_tx_enable()
78 		rpm_write(rpm, lmac_id, RPMX_MTI_MAC100X_COMMAND_CONFIG, cfg);  in rpm_lmac_tx_enable()
85 	u64 cfg;  in rpm_lmac_rx_tx_enable()  local
90 	cfg = rpm_read(rpm, lmac_id, RPMX_MTI_MAC100X_COMMAND_CONFIG);  in rpm_lmac_rx_tx_enable()
92 		cfg |= RPM_RX_EN | RPM_TX_EN;  in rpm_lmac_rx_tx_enable()
94 		cfg &= ~(RPM_RX_EN | RPM_TX_EN);  in rpm_lmac_rx_tx_enable()
95 	rpm_write(rpm, lmac_id, RPMX_MTI_MAC100X_COMMAND_CONFIG, cfg);  in rpm_lmac_rx_tx_enable()
103 	u64 cfg;  in rpm_lmac_enadis_rx_pause_fwding()  local
117 		cfg = rpm_read(rpm, lmac_id, RPMX_MTI_MAC100X_COMMAND_CONFIG);  in rpm_lmac_enadis_rx_pause_fwding()
118 		cfg &= ~RPMX_MTI_MAC100X_COMMAND_CONFIG_PAUSE_IGNORE;  in rpm_lmac_enadis_rx_pause_fwding()
119 		rpm_write(rpm, lmac_id, RPMX_MTI_MAC100X_COMMAND_CONFIG, cfg);  in rpm_lmac_enadis_rx_pause_fwding()
121 		cfg = rpm_read(rpm, lmac_id, RPMX_MTI_MAC100X_COMMAND_CONFIG);  in rpm_lmac_enadis_rx_pause_fwding()
122 		cfg |= RPMX_MTI_MAC100X_COMMAND_CONFIG_PAUSE_IGNORE;  in rpm_lmac_enadis_rx_pause_fwding()
123 		rpm_write(rpm, lmac_id, RPMX_MTI_MAC100X_COMMAND_CONFIG, cfg);  in rpm_lmac_enadis_rx_pause_fwding()
131 	u64 cfg;  in rpm_lmac_get_pause_frm_status()  local
136 	cfg = rpm_read(rpm, lmac_id, RPMX_MTI_MAC100X_COMMAND_CONFIG);  in rpm_lmac_get_pause_frm_status()
137 	if (!(cfg & RPMX_MTI_MAC100X_COMMAND_CONFIG_PFC_MODE)) {  in rpm_lmac_get_pause_frm_status()
138 		*rx_pause = !(cfg & RPMX_MTI_MAC100X_COMMAND_CONFIG_RX_P_DISABLE);  in rpm_lmac_get_pause_frm_status()
139 		*tx_pause = !(cfg & RPMX_MTI_MAC100X_COMMAND_CONFIG_TX_P_DISABLE);  in rpm_lmac_get_pause_frm_status()
149 	u64 quanta_offset = 0, quanta_thresh = 0, cfg;  in rpm_cfg_pfc_quanta_thresh()  local
201 		cfg = rpm_read(rpm, lmac_id, quanta_offset);  in rpm_cfg_pfc_quanta_thresh()
203 			cfg |= ((u64)RPM_DEFAULT_PAUSE_TIME <<  shift * 16);  in rpm_cfg_pfc_quanta_thresh()
206 				cfg &= ~GENMASK_ULL(15, 0);  in rpm_cfg_pfc_quanta_thresh()
208 				cfg &= ~GENMASK_ULL(31, 16);  in rpm_cfg_pfc_quanta_thresh()
210 		rpm_write(rpm, lmac_id, quanta_offset, cfg);  in rpm_cfg_pfc_quanta_thresh()
212 		cfg = rpm_read(rpm, lmac_id, quanta_thresh);  in rpm_cfg_pfc_quanta_thresh()
214 			cfg |= ((u64)(RPM_DEFAULT_PAUSE_TIME / 2) <<  shift * 16);  in rpm_cfg_pfc_quanta_thresh()
217 				cfg &= ~GENMASK_ULL(15, 0);  in rpm_cfg_pfc_quanta_thresh()
219 				cfg &= ~GENMASK_ULL(31, 16);  in rpm_cfg_pfc_quanta_thresh()
221 		rpm_write(rpm, lmac_id, quanta_thresh, cfg);  in rpm_cfg_pfc_quanta_thresh()
229 	u64 cfg;  in rpm_lmac_enadis_pause_frm()  local
234 	cfg = rpm_read(rpm, lmac_id, RPMX_MTI_MAC100X_COMMAND_CONFIG);  in rpm_lmac_enadis_pause_frm()
235 	cfg &= ~RPMX_MTI_MAC100X_COMMAND_CONFIG_RX_P_DISABLE;  in rpm_lmac_enadis_pause_frm()
236 	cfg |= rx_pause ? 0x0 : RPMX_MTI_MAC100X_COMMAND_CONFIG_RX_P_DISABLE;  in rpm_lmac_enadis_pause_frm()
237 	cfg &= ~RPMX_MTI_MAC100X_COMMAND_CONFIG_PAUSE_IGNORE;  in rpm_lmac_enadis_pause_frm()
238 	cfg |= rx_pause ? 0x0 : RPMX_MTI_MAC100X_COMMAND_CONFIG_PAUSE_IGNORE;  in rpm_lmac_enadis_pause_frm()
239 	rpm_write(rpm, lmac_id, RPMX_MTI_MAC100X_COMMAND_CONFIG, cfg);  in rpm_lmac_enadis_pause_frm()
241 	cfg = rpm_read(rpm, lmac_id, RPMX_MTI_MAC100X_COMMAND_CONFIG);  in rpm_lmac_enadis_pause_frm()
242 	cfg &= ~RPMX_MTI_MAC100X_COMMAND_CONFIG_TX_P_DISABLE;  in rpm_lmac_enadis_pause_frm()
243 	cfg |= tx_pause ? 0x0 : RPMX_MTI_MAC100X_COMMAND_CONFIG_TX_P_DISABLE;  in rpm_lmac_enadis_pause_frm()
244 	rpm_write(rpm, lmac_id, RPMX_MTI_MAC100X_COMMAND_CONFIG, cfg);  in rpm_lmac_enadis_pause_frm()
246 	cfg = rpm_read(rpm, 0, RPMX_CMR_RX_OVR_BP);  in rpm_lmac_enadis_pause_frm()
250 		cfg &= ~RPMX_CMR_RX_OVR_BP_EN(lmac_id);  in rpm_lmac_enadis_pause_frm()
254 		cfg |= RPMX_CMR_RX_OVR_BP_EN(lmac_id);  in rpm_lmac_enadis_pause_frm()
255 		cfg &= ~RPMX_CMR_RX_OVR_BP_BP(lmac_id);  in rpm_lmac_enadis_pause_frm()
257 	rpm_write(rpm, 0, RPMX_CMR_RX_OVR_BP, cfg);  in rpm_lmac_enadis_pause_frm()
264 	u64 cfg;  in rpm_lmac_pause_frm_config()  local
267 	cfg = rpm_read(rpm, lmac_id, RPMX_MTI_MAC100X_COMMAND_CONFIG);  in rpm_lmac_pause_frm_config()
268 	cfg |= RPMX_MTI_MAC100X_COMMAND_CONFIG_RX_P_DISABLE;  in rpm_lmac_pause_frm_config()
269 	rpm_write(rpm, lmac_id, RPMX_MTI_MAC100X_COMMAND_CONFIG, cfg);  in rpm_lmac_pause_frm_config()
272 	cfg = rpm_read(rpm, lmac_id, RPMX_MTI_MAC100X_COMMAND_CONFIG);  in rpm_lmac_pause_frm_config()
273 	cfg |= RPMX_MTI_MAC100X_COMMAND_CONFIG_PAUSE_IGNORE;  in rpm_lmac_pause_frm_config()
274 	rpm_write(rpm, lmac_id, RPMX_MTI_MAC100X_COMMAND_CONFIG, cfg);  in rpm_lmac_pause_frm_config()
277 	cfg = rpm_read(rpm, lmac_id, RPMX_MTI_MAC100X_COMMAND_CONFIG);  in rpm_lmac_pause_frm_config()
278 	cfg |= RPMX_MTI_MAC100X_COMMAND_CONFIG_TX_P_DISABLE;  in rpm_lmac_pause_frm_config()
279 	rpm_write(rpm, lmac_id, RPMX_MTI_MAC100X_COMMAND_CONFIG, cfg);  in rpm_lmac_pause_frm_config()
282 	cfg = rpm_read(rpm, lmac_id, RPMX_CMRX_PRT_CBFC_CTL);  in rpm_lmac_pause_frm_config()
283 	cfg = FIELD_SET(RPM_PFC_CLASS_MASK, 0, cfg);  in rpm_lmac_pause_frm_config()
284 	rpm_write(rpm, lmac_id, RPMX_CMRX_PRT_CBFC_CTL, cfg);  in rpm_lmac_pause_frm_config()
387 	u64 cfg;  in rpm_lmac_internal_loopback()  local
398 	cfg = rpm_read(rpm, lmac_id, RPMX_MTI_PCS100X_CONTROL1);  in rpm_lmac_internal_loopback()
401 		cfg |= RPMX_MTI_PCS_LBK;  in rpm_lmac_internal_loopback()
403 		cfg &= ~RPMX_MTI_PCS_LBK;  in rpm_lmac_internal_loopback()
404 	rpm_write(rpm, lmac_id, RPMX_MTI_PCS100X_CONTROL1, cfg);  in rpm_lmac_internal_loopback()
412 	u64 cfg;  in rpm_lmac_ptp_config()  local
417 	cfg = rpm_read(rpm, lmac_id, RPMX_CMRX_CFG);  in rpm_lmac_ptp_config()
419 		cfg |= RPMX_RX_TS_PREPEND;  in rpm_lmac_ptp_config()
420 		cfg |= RPMX_TX_PTP_1S_SUPPORT;  in rpm_lmac_ptp_config()
422 		cfg &= ~RPMX_RX_TS_PREPEND;  in rpm_lmac_ptp_config()
423 		cfg &= ~RPMX_TX_PTP_1S_SUPPORT;  in rpm_lmac_ptp_config()
426 	rpm_write(rpm, lmac_id, RPMX_CMRX_CFG, cfg);  in rpm_lmac_ptp_config()
428 	cfg = rpm_read(rpm, lmac_id, RPMX_MTI_MAC100X_XIF_MODE);  in rpm_lmac_ptp_config()
431 		cfg |= RPMX_ONESTEP_ENABLE;  in rpm_lmac_ptp_config()
432 		cfg &= ~RPMX_TS_BINARY_MODE;  in rpm_lmac_ptp_config()
434 		cfg &= ~RPMX_ONESTEP_ENABLE;  in rpm_lmac_ptp_config()
437 	rpm_write(rpm, lmac_id, RPMX_MTI_MAC100X_XIF_MODE, cfg);  in rpm_lmac_ptp_config()
443 	u64 cfg, class_en;  in rpm_lmac_pfc_config()  local
448 	cfg = rpm_read(rpm, lmac_id, RPMX_MTI_MAC100X_COMMAND_CONFIG);  in rpm_lmac_pfc_config()
453 		cfg &= ~(RPMX_MTI_MAC100X_COMMAND_CONFIG_RX_P_DISABLE |  in rpm_lmac_pfc_config()
457 		cfg |= (RPMX_MTI_MAC100X_COMMAND_CONFIG_RX_P_DISABLE |  in rpm_lmac_pfc_config()
464 		cfg &= ~RPMX_MTI_MAC100X_COMMAND_CONFIG_TX_P_DISABLE;  in rpm_lmac_pfc_config()
468 		cfg |= RPMX_MTI_MAC100X_COMMAND_CONFIG_TX_P_DISABLE;  in rpm_lmac_pfc_config()
473 		cfg &= ~RPMX_MTI_MAC100X_COMMAND_CONFIG_PFC_MODE;  in rpm_lmac_pfc_config()
475 		cfg |= RPMX_MTI_MAC100X_COMMAND_CONFIG_PFC_MODE;  in rpm_lmac_pfc_config()
477 	rpm_write(rpm, lmac_id, RPMX_MTI_MAC100X_COMMAND_CONFIG, cfg);  in rpm_lmac_pfc_config()
487 	u64 cfg;  in rpm_lmac_get_pfc_frm_cfg()  local
492 	cfg = rpm_read(rpm, lmac_id, RPMX_MTI_MAC100X_COMMAND_CONFIG);  in rpm_lmac_get_pfc_frm_cfg()
493 	if (cfg & RPMX_MTI_MAC100X_COMMAND_CONFIG_PFC_MODE) {  in rpm_lmac_get_pfc_frm_cfg()
494 		*rx_pause = !(cfg & RPMX_MTI_MAC100X_COMMAND_CONFIG_RX_P_DISABLE);  in rpm_lmac_get_pfc_frm_cfg()
495 		*tx_pause = !(cfg & RPMX_MTI_MAC100X_COMMAND_CONFIG_TX_P_DISABLE);  in rpm_lmac_get_pfc_frm_cfg()