1 // SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause
3  * Northstar Plus switch SerDes/SGMII PHY main logic
12 #include <linux/phy.h>
20 static inline struct b53_pcs *pcs_to_b53_pcs(struct phylink_pcs *pcs)  in pcs_to_b53_pcs()  argument
22 	return container_of(pcs, struct b53_pcs, pcs);  in pcs_to_b53_pcs()
44 	if (dev->serdes_lane == lane)  in b53_serdes_set_lane()
51 	dev->serdes_lane = lane;  in b53_serdes_set_lane()
68 static int b53_serdes_config(struct phylink_pcs *pcs, unsigned int neg_mode,  in b53_serdes_config()  argument
73 	struct b53_device *dev = pcs_to_b53_pcs(pcs)->dev;  in b53_serdes_config()
74 	u8 lane = pcs_to_b53_pcs(pcs)->lane;  in b53_serdes_config()
89 static void b53_serdes_an_restart(struct phylink_pcs *pcs)  in b53_serdes_an_restart()  argument
91 	struct b53_device *dev = pcs_to_b53_pcs(pcs)->dev;  in b53_serdes_an_restart()
92 	u8 lane = pcs_to_b53_pcs(pcs)->lane;  in b53_serdes_an_restart()
102 static void b53_serdes_get_state(struct phylink_pcs *pcs,  in b53_serdes_get_state()  argument
105 	struct b53_device *dev = pcs_to_b53_pcs(pcs)->dev;  in b53_serdes_get_state()
106 	u8 lane = pcs_to_b53_pcs(pcs)->lane;  in b53_serdes_get_state()
116 		state->speed = SPEED_10;  in b53_serdes_get_state()
119 		state->speed = SPEED_100;  in b53_serdes_get_state()
122 		state->speed = SPEED_1000;  in b53_serdes_get_state()
126 		state->speed = SPEED_2500;  in b53_serdes_get_state()
130 	state->duplex = dig & DUPLEX_STATUS ? DUPLEX_FULL : DUPLEX_HALF;  in b53_serdes_get_state()
131 	state->an_complete = !!(bmsr & BMSR_ANEGCOMPLETE);  in b53_serdes_get_state()
132 	state->link = !!(dig & LINK_STATUS);  in b53_serdes_get_state()
134 		state->pause |= MLO_PAUSE_RX;  in b53_serdes_get_state()
136 		state->pause |= MLO_PAUSE_TX;  in b53_serdes_get_state()
175 		/* It appears lane 0 supports 2500base-X and 1000base-X */  in b53_serdes_phylink_get_caps()
177 			  config->supported_interfaces);  in b53_serdes_phylink_get_caps()
178 		config->mac_capabilities |= MAC_2500FD;  in b53_serdes_phylink_get_caps()
181 		/* It appears lane 1 only supports 1000base-X and SGMII */  in b53_serdes_phylink_get_caps()
183 			  config->supported_interfaces);  in b53_serdes_phylink_get_caps()
185 			  config->supported_interfaces);  in b53_serdes_phylink_get_caps()
186 		config->mac_capabilities |= MAC_1000FD;  in b53_serdes_phylink_get_caps()
201 	    !dev->pcs[lane].dev)  in b53_serdes_phylink_mac_select_pcs()
208 	return &dev->pcs[lane].pcs;  in b53_serdes_phylink_mac_select_pcs()
215 	struct b53_pcs *pcs;  in b53_serdes_init()  local
219 		return -EINVAL;  in b53_serdes_init()
227 		dev_err(dev->dev, "SerDes not initialized, check settings\n");  in b53_serdes_init()
228 		return -ENODEV;  in b53_serdes_init()
231 	dev_info(dev->dev,  in b53_serdes_init()
238 	pcs = &dev->pcs[lane];  in b53_serdes_init()
239 	pcs->dev = dev;  in b53_serdes_init()
240 	pcs->lane = lane;  in b53_serdes_init()
241 	pcs->pcs.ops = &b53_pcs_ops;  in b53_serdes_init()
242 	pcs->pcs.neg_mode = true;  in b53_serdes_init()