649 static int sparx5_sd10g25_get_mode_preset(struct sparx5_serdes_macro *macro,  in sparx5_sd10g25_get_mode_preset()  argument
652 	switch (macro->serdesmode) {  in sparx5_sd10g25_get_mode_preset()
654 		if (macro->speed == SPEED_25000)  in sparx5_sd10g25_get_mode_preset()
656 		else if (macro->speed == SPEED_10000)  in sparx5_sd10g25_get_mode_preset()
658 		else if (macro->speed == SPEED_5000)  in sparx5_sd10g25_get_mode_preset()
677 static int sparx5_sd10g28_get_mode_preset(struct sparx5_serdes_macro *macro,  in sparx5_sd10g28_get_mode_preset()  argument
681 	switch (macro->serdesmode) {  in sparx5_sd10g28_get_mode_preset()
683 		if (macro->speed == SPEED_10000) {  in sparx5_sd10g28_get_mode_preset()
685 		} else if (macro->speed == SPEED_5000) {  in sparx5_sd10g28_get_mode_preset()
691 			dev_err(macro->priv->dev, "%s: Illegal speed: %02u, sidx: %02u, mode (%u)",  in sparx5_sd10g28_get_mode_preset()
692 			       __func__, macro->speed, macro->sidx,  in sparx5_sd10g28_get_mode_preset()
693 			       macro->serdesmode);  in sparx5_sd10g28_get_mode_preset()
714 static void sparx5_sd25g28_get_params(struct sparx5_serdes_macro *macro,  in sparx5_sd25g28_get_params()  argument
720 	u8 iw = sd25g28_get_iw_setting(macro->priv->dev, mode->bitwidth);  in sparx5_sd25g28_get_params()
824 static void sparx5_sd10g28_get_params(struct sparx5_serdes_macro *macro,  in sparx5_sd10g28_get_params()  argument
830 	u8 iw = sd10g28_get_iw_setting(macro->priv->dev, mode->bwidth);  in sparx5_sd10g28_get_params()
840 		.fx_100                      = macro->serdesmode == SPX5_SD_MODE_100FX,  in sparx5_sd10g28_get_params()
1163 static int sparx5_sd25g28_apply_params(struct sparx5_serdes_macro *macro,  in sparx5_sd25g28_apply_params()  argument
1166 	struct sparx5_serdes_private *priv = macro->priv;  in sparx5_sd25g28_apply_params()
1169 	u32 sd_index = macro->stpidx;  in sparx5_sd25g28_apply_params()
1637 static int sparx5_sd10g28_apply_params(struct sparx5_serdes_macro *macro,  in sparx5_sd10g28_apply_params()  argument
1640 	struct sparx5_serdes_private *priv = macro->priv;  in sparx5_sd10g28_apply_params()
1643 	u32 lane_index = macro->sidx;  in sparx5_sd10g28_apply_params()
1644 	u32 sd_index = macro->stpidx;  in sparx5_sd10g28_apply_params()
2085 static int sparx5_sd25g28_config(struct sparx5_serdes_macro *macro, bool reset)  in sparx5_sd25g28_config()  argument
2087 	struct sparx5_sd25g28_media_preset media = media_presets_25g[macro->media];  in sparx5_sd25g28_config()
2099 	err = sparx5_sd10g25_get_mode_preset(macro, &mode);  in sparx5_sd25g28_config()
2102 	sparx5_sd25g28_get_params(macro, &media, &mode, &args, &params);  in sparx5_sd25g28_config()
2103 	sparx5_sd25g28_reset(macro->priv->regs, &params, macro->stpidx);  in sparx5_sd25g28_config()
2104 	return sparx5_sd25g28_apply_params(macro, &params);  in sparx5_sd25g28_config()
2107 static int sparx5_sd10g28_config(struct sparx5_serdes_macro *macro, bool reset)  in sparx5_sd10g28_config()  argument
2109 	struct sparx5_sd10g28_media_preset media = media_presets_10g[macro->media];  in sparx5_sd10g28_config()
2113 		.is_6g = (macro->serdestype == SPX5_SDT_6G),  in sparx5_sd10g28_config()
2122 	err = sparx5_sd10g28_get_mode_preset(macro, &mode, &args);  in sparx5_sd10g28_config()
2125 	sparx5_sd10g28_get_params(macro, &media, &mode, &args, &params);  in sparx5_sd10g28_config()
2126 	sparx5_sd10g28_reset(macro->priv->regs, macro->sidx);  in sparx5_sd10g28_config()
2127 	return sparx5_sd10g28_apply_params(macro, &params);  in sparx5_sd10g28_config()
2131 static int sparx5_serdes_power_save(struct sparx5_serdes_macro *macro, u32 pwdn)  in sparx5_serdes_power_save()  argument
2133 	struct sparx5_serdes_private *priv = macro->priv;  in sparx5_serdes_power_save()
2136 	if (macro->serdestype == SPX5_SDT_6G)  in sparx5_serdes_power_save()
2137 		sd_inst = sdx5_inst_get(priv, TARGET_SD6G_LANE, macro->stpidx);  in sparx5_serdes_power_save()
2138 	else if (macro->serdestype == SPX5_SDT_10G)  in sparx5_serdes_power_save()
2139 		sd_inst = sdx5_inst_get(priv, TARGET_SD10G_LANE, macro->stpidx);  in sparx5_serdes_power_save()
2141 		sd_inst = sdx5_inst_get(priv, TARGET_SD25G_LANE, macro->stpidx);  in sparx5_serdes_power_save()
2143 	if (macro->serdestype == SPX5_SDT_25G) {  in sparx5_serdes_power_save()
2145 					     macro->stpidx);  in sparx5_serdes_power_save()
2162 		sd_lane_inst = sdx5_inst_get(priv, TARGET_SD_LANE, macro->sidx);  in sparx5_serdes_power_save()
2182 static int sparx5_serdes_clock_config(struct sparx5_serdes_macro *macro)  in sparx5_serdes_clock_config()  argument
2184 	struct sparx5_serdes_private *priv = macro->priv;  in sparx5_serdes_clock_config()
2186 	if (macro->serdesmode == SPX5_SD_MODE_100FX) {  in sparx5_serdes_clock_config()
2193 			 SD_LANE_MISC(macro->sidx));  in sparx5_serdes_clock_config()
2220 static int sparx5_serdes_config(struct sparx5_serdes_macro *macro)  in sparx5_serdes_config()  argument
2222 	struct device *dev = macro->priv->dev;  in sparx5_serdes_config()
2226 	serdesmode = sparx5_serdes_get_serdesmode(macro->portmode, macro->speed);  in sparx5_serdes_config()
2229 			macro->sidx,  in sparx5_serdes_config()
2230 			phy_modes(macro->portmode));  in sparx5_serdes_config()
2233 	macro->serdesmode = serdesmode;  in sparx5_serdes_config()
2235 	sparx5_serdes_clock_config(macro);  in sparx5_serdes_config()
2237 	if (macro->serdestype == SPX5_SDT_25G)  in sparx5_serdes_config()
2238 		err = sparx5_sd25g28_config(macro, false);  in sparx5_serdes_config()
2240 		err = sparx5_sd10g28_config(macro, false);  in sparx5_serdes_config()
2243 			macro->sidx, err);  in sparx5_serdes_config()
2250 	struct sparx5_serdes_macro *macro = phy_get_drvdata(phy);  in sparx5_serdes_power_on()  local
2252 	return sparx5_serdes_power_save(macro, false);  in sparx5_serdes_power_on()
2257 	struct sparx5_serdes_macro *macro = phy_get_drvdata(phy);  in sparx5_serdes_power_off()  local
2259 	return sparx5_serdes_power_save(macro, true);  in sparx5_serdes_power_off()
2264 	struct sparx5_serdes_macro *macro;  in sparx5_serdes_set_mode()  local
2275 		macro = phy_get_drvdata(phy);  in sparx5_serdes_set_mode()
2276 		macro->portmode = submode;  in sparx5_serdes_set_mode()
2277 		sparx5_serdes_config(macro);  in sparx5_serdes_set_mode()
2286 	struct sparx5_serdes_macro *macro = phy_get_drvdata(phy);  in sparx5_serdes_set_media()  local
2288 	if (media != macro->media) {  in sparx5_serdes_set_media()
2289 		macro->media = media;  in sparx5_serdes_set_media()
2290 		if (macro->serdesmode != SPX5_SD_MODE_NONE)  in sparx5_serdes_set_media()
2291 			sparx5_serdes_config(macro);  in sparx5_serdes_set_media()
2298 	struct sparx5_serdes_macro *macro = phy_get_drvdata(phy);  in sparx5_serdes_set_speed()  local
2300 	if (macro->sidx < SPX5_SERDES_10G_START && speed > SPEED_5000)  in sparx5_serdes_set_speed()
2302 	if (macro->sidx < SPX5_SERDES_25G_START && speed > SPEED_10000)  in sparx5_serdes_set_speed()
2304 	if (speed != macro->speed) {  in sparx5_serdes_set_speed()
2305 		macro->speed = speed;  in sparx5_serdes_set_speed()
2306 		if (macro->serdesmode != SPX5_SD_MODE_NONE)  in sparx5_serdes_set_speed()
2307 			sparx5_serdes_config(macro);  in sparx5_serdes_set_speed()
2314 	struct sparx5_serdes_macro *macro = phy_get_drvdata(phy);  in sparx5_serdes_reset()  local
2317 	if (macro->serdestype == SPX5_SDT_25G)  in sparx5_serdes_reset()
2318 		err = sparx5_sd25g28_config(macro, true);  in sparx5_serdes_reset()
2320 		err = sparx5_sd10g28_config(macro, true);  in sparx5_serdes_reset()
2323 			macro->sidx, err);  in sparx5_serdes_reset()
2332 	struct sparx5_serdes_macro *macro = phy_get_drvdata(phy);  in sparx5_serdes_validate()  local
2337 	if (macro->speed == 0)  in sparx5_serdes_validate()
2340 	if (macro->sidx < SPX5_SERDES_10G_START && macro->speed > SPEED_5000)  in sparx5_serdes_validate()
2342 	if (macro->sidx < SPX5_SERDES_25G_START && macro->speed > SPEED_10000)  in sparx5_serdes_validate()
2347 		if (macro->speed != SPEED_100 && /* This is for 100BASE-FX */  in sparx5_serdes_validate()
2348 		    macro->speed != SPEED_1000)  in sparx5_serdes_validate()
2354 		if (macro->speed >= SPEED_5000)  in sparx5_serdes_validate()
2358 		if (macro->speed < SPEED_5000)  in sparx5_serdes_validate()
2381 	struct sparx5_serdes_macro *macro;  in sparx5_phy_create()  local
2387 	macro = devm_kzalloc(priv->dev, sizeof(*macro), GFP_KERNEL);  in sparx5_phy_create()
2388 	if (!macro)  in sparx5_phy_create()
2391 	macro->sidx = idx;  in sparx5_phy_create()
2392 	macro->priv = priv;  in sparx5_phy_create()
2393 	macro->speed = SPEED_UNKNOWN;  in sparx5_phy_create()
2395 		macro->serdestype = SPX5_SDT_6G;  in sparx5_phy_create()
2396 		macro->stpidx = macro->sidx;  in sparx5_phy_create()
2398 		macro->serdestype = SPX5_SDT_10G;  in sparx5_phy_create()
2399 		macro->stpidx = macro->sidx - SPX5_SERDES_10G_START;  in sparx5_phy_create()
2401 		macro->serdestype = SPX5_SDT_25G;  in sparx5_phy_create()
2402 		macro->stpidx = macro->sidx - SPX5_SERDES_25G_START;  in sparx5_phy_create()
2405 	phy_set_drvdata(*phy, macro);  in sparx5_phy_create()
2525 		struct sparx5_serdes_macro *macro =  in sparx5_serdes_xlate()  local
2528 		if (sidx != macro->sidx)  in sparx5_serdes_xlate()