xref: /OK3568_Linux_fs/kernel/drivers/net/phy/micrel.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0+
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun  * drivers/net/phy/micrel.c
4*4882a593Smuzhiyun  *
5*4882a593Smuzhiyun  * Driver for Micrel PHYs
6*4882a593Smuzhiyun  *
7*4882a593Smuzhiyun  * Author: David J. Choi
8*4882a593Smuzhiyun  *
9*4882a593Smuzhiyun  * Copyright (c) 2010-2013 Micrel, Inc.
10*4882a593Smuzhiyun  * Copyright (c) 2014 Johan Hovold <johan@kernel.org>
11*4882a593Smuzhiyun  *
12*4882a593Smuzhiyun  * Support : Micrel Phys:
13*4882a593Smuzhiyun  *		Giga phys: ksz9021, ksz9031, ksz9131
14*4882a593Smuzhiyun  *		100/10 Phys : ksz8001, ksz8721, ksz8737, ksz8041
15*4882a593Smuzhiyun  *			   ksz8021, ksz8031, ksz8051,
16*4882a593Smuzhiyun  *			   ksz8081, ksz8091,
17*4882a593Smuzhiyun  *			   ksz8061,
18*4882a593Smuzhiyun  *		Switch : ksz8873, ksz886x
19*4882a593Smuzhiyun  *			 ksz9477
20*4882a593Smuzhiyun  */
21*4882a593Smuzhiyun 
22*4882a593Smuzhiyun #include <linux/bitfield.h>
23*4882a593Smuzhiyun #include <linux/kernel.h>
24*4882a593Smuzhiyun #include <linux/module.h>
25*4882a593Smuzhiyun #include <linux/phy.h>
26*4882a593Smuzhiyun #include <linux/micrel_phy.h>
27*4882a593Smuzhiyun #include <linux/of.h>
28*4882a593Smuzhiyun #include <linux/clk.h>
29*4882a593Smuzhiyun #include <linux/delay.h>
30*4882a593Smuzhiyun 
31*4882a593Smuzhiyun /* Operation Mode Strap Override */
32*4882a593Smuzhiyun #define MII_KSZPHY_OMSO				0x16
33*4882a593Smuzhiyun #define KSZPHY_OMSO_FACTORY_TEST		BIT(15)
34*4882a593Smuzhiyun #define KSZPHY_OMSO_B_CAST_OFF			BIT(9)
35*4882a593Smuzhiyun #define KSZPHY_OMSO_NAND_TREE_ON		BIT(5)
36*4882a593Smuzhiyun #define KSZPHY_OMSO_RMII_OVERRIDE		BIT(1)
37*4882a593Smuzhiyun #define KSZPHY_OMSO_MII_OVERRIDE		BIT(0)
38*4882a593Smuzhiyun 
39*4882a593Smuzhiyun /* general Interrupt control/status reg in vendor specific block. */
40*4882a593Smuzhiyun #define MII_KSZPHY_INTCS			0x1B
41*4882a593Smuzhiyun #define	KSZPHY_INTCS_JABBER			BIT(15)
42*4882a593Smuzhiyun #define	KSZPHY_INTCS_RECEIVE_ERR		BIT(14)
43*4882a593Smuzhiyun #define	KSZPHY_INTCS_PAGE_RECEIVE		BIT(13)
44*4882a593Smuzhiyun #define	KSZPHY_INTCS_PARELLEL			BIT(12)
45*4882a593Smuzhiyun #define	KSZPHY_INTCS_LINK_PARTNER_ACK		BIT(11)
46*4882a593Smuzhiyun #define	KSZPHY_INTCS_LINK_DOWN			BIT(10)
47*4882a593Smuzhiyun #define	KSZPHY_INTCS_REMOTE_FAULT		BIT(9)
48*4882a593Smuzhiyun #define	KSZPHY_INTCS_LINK_UP			BIT(8)
49*4882a593Smuzhiyun #define	KSZPHY_INTCS_ALL			(KSZPHY_INTCS_LINK_UP |\
50*4882a593Smuzhiyun 						KSZPHY_INTCS_LINK_DOWN)
51*4882a593Smuzhiyun 
52*4882a593Smuzhiyun /* PHY Control 1 */
53*4882a593Smuzhiyun #define	MII_KSZPHY_CTRL_1			0x1e
54*4882a593Smuzhiyun 
55*4882a593Smuzhiyun /* PHY Control 2 / PHY Control (if no PHY Control 1) */
56*4882a593Smuzhiyun #define	MII_KSZPHY_CTRL_2			0x1f
57*4882a593Smuzhiyun #define	MII_KSZPHY_CTRL				MII_KSZPHY_CTRL_2
58*4882a593Smuzhiyun /* bitmap of PHY register to set interrupt mode */
59*4882a593Smuzhiyun #define KSZPHY_CTRL_INT_ACTIVE_HIGH		BIT(9)
60*4882a593Smuzhiyun #define KSZPHY_RMII_REF_CLK_SEL			BIT(7)
61*4882a593Smuzhiyun 
62*4882a593Smuzhiyun /* Write/read to/from extended registers */
63*4882a593Smuzhiyun #define MII_KSZPHY_EXTREG                       0x0b
64*4882a593Smuzhiyun #define KSZPHY_EXTREG_WRITE                     0x8000
65*4882a593Smuzhiyun 
66*4882a593Smuzhiyun #define MII_KSZPHY_EXTREG_WRITE                 0x0c
67*4882a593Smuzhiyun #define MII_KSZPHY_EXTREG_READ                  0x0d
68*4882a593Smuzhiyun 
69*4882a593Smuzhiyun /* Extended registers */
70*4882a593Smuzhiyun #define MII_KSZPHY_CLK_CONTROL_PAD_SKEW         0x104
71*4882a593Smuzhiyun #define MII_KSZPHY_RX_DATA_PAD_SKEW             0x105
72*4882a593Smuzhiyun #define MII_KSZPHY_TX_DATA_PAD_SKEW             0x106
73*4882a593Smuzhiyun 
74*4882a593Smuzhiyun #define PS_TO_REG				200
75*4882a593Smuzhiyun 
76*4882a593Smuzhiyun struct kszphy_hw_stat {
77*4882a593Smuzhiyun 	const char *string;
78*4882a593Smuzhiyun 	u8 reg;
79*4882a593Smuzhiyun 	u8 bits;
80*4882a593Smuzhiyun };
81*4882a593Smuzhiyun 
82*4882a593Smuzhiyun static struct kszphy_hw_stat kszphy_hw_stats[] = {
83*4882a593Smuzhiyun 	{ "phy_receive_errors", 21, 16},
84*4882a593Smuzhiyun 	{ "phy_idle_errors", 10, 8 },
85*4882a593Smuzhiyun };
86*4882a593Smuzhiyun 
87*4882a593Smuzhiyun struct kszphy_type {
88*4882a593Smuzhiyun 	u32 led_mode_reg;
89*4882a593Smuzhiyun 	u16 interrupt_level_mask;
90*4882a593Smuzhiyun 	bool has_broadcast_disable;
91*4882a593Smuzhiyun 	bool has_nand_tree_disable;
92*4882a593Smuzhiyun 	bool has_rmii_ref_clk_sel;
93*4882a593Smuzhiyun };
94*4882a593Smuzhiyun 
95*4882a593Smuzhiyun struct kszphy_priv {
96*4882a593Smuzhiyun 	const struct kszphy_type *type;
97*4882a593Smuzhiyun 	int led_mode;
98*4882a593Smuzhiyun 	bool rmii_ref_clk_sel;
99*4882a593Smuzhiyun 	bool rmii_ref_clk_sel_val;
100*4882a593Smuzhiyun 	u64 stats[ARRAY_SIZE(kszphy_hw_stats)];
101*4882a593Smuzhiyun };
102*4882a593Smuzhiyun 
103*4882a593Smuzhiyun static const struct kszphy_type ksz8021_type = {
104*4882a593Smuzhiyun 	.led_mode_reg		= MII_KSZPHY_CTRL_2,
105*4882a593Smuzhiyun 	.has_broadcast_disable	= true,
106*4882a593Smuzhiyun 	.has_nand_tree_disable	= true,
107*4882a593Smuzhiyun 	.has_rmii_ref_clk_sel	= true,
108*4882a593Smuzhiyun };
109*4882a593Smuzhiyun 
110*4882a593Smuzhiyun static const struct kszphy_type ksz8041_type = {
111*4882a593Smuzhiyun 	.led_mode_reg		= MII_KSZPHY_CTRL_1,
112*4882a593Smuzhiyun };
113*4882a593Smuzhiyun 
114*4882a593Smuzhiyun static const struct kszphy_type ksz8051_type = {
115*4882a593Smuzhiyun 	.led_mode_reg		= MII_KSZPHY_CTRL_2,
116*4882a593Smuzhiyun 	.has_nand_tree_disable	= true,
117*4882a593Smuzhiyun };
118*4882a593Smuzhiyun 
119*4882a593Smuzhiyun static const struct kszphy_type ksz8081_type = {
120*4882a593Smuzhiyun 	.led_mode_reg		= MII_KSZPHY_CTRL_2,
121*4882a593Smuzhiyun 	.has_broadcast_disable	= true,
122*4882a593Smuzhiyun 	.has_nand_tree_disable	= true,
123*4882a593Smuzhiyun 	.has_rmii_ref_clk_sel	= true,
124*4882a593Smuzhiyun };
125*4882a593Smuzhiyun 
126*4882a593Smuzhiyun static const struct kszphy_type ks8737_type = {
127*4882a593Smuzhiyun 	.interrupt_level_mask	= BIT(14),
128*4882a593Smuzhiyun };
129*4882a593Smuzhiyun 
130*4882a593Smuzhiyun static const struct kszphy_type ksz9021_type = {
131*4882a593Smuzhiyun 	.interrupt_level_mask	= BIT(14),
132*4882a593Smuzhiyun };
133*4882a593Smuzhiyun 
kszphy_extended_write(struct phy_device * phydev,u32 regnum,u16 val)134*4882a593Smuzhiyun static int kszphy_extended_write(struct phy_device *phydev,
135*4882a593Smuzhiyun 				u32 regnum, u16 val)
136*4882a593Smuzhiyun {
137*4882a593Smuzhiyun 	phy_write(phydev, MII_KSZPHY_EXTREG, KSZPHY_EXTREG_WRITE | regnum);
138*4882a593Smuzhiyun 	return phy_write(phydev, MII_KSZPHY_EXTREG_WRITE, val);
139*4882a593Smuzhiyun }
140*4882a593Smuzhiyun 
kszphy_extended_read(struct phy_device * phydev,u32 regnum)141*4882a593Smuzhiyun static int kszphy_extended_read(struct phy_device *phydev,
142*4882a593Smuzhiyun 				u32 regnum)
143*4882a593Smuzhiyun {
144*4882a593Smuzhiyun 	phy_write(phydev, MII_KSZPHY_EXTREG, regnum);
145*4882a593Smuzhiyun 	return phy_read(phydev, MII_KSZPHY_EXTREG_READ);
146*4882a593Smuzhiyun }
147*4882a593Smuzhiyun 
kszphy_ack_interrupt(struct phy_device * phydev)148*4882a593Smuzhiyun static int kszphy_ack_interrupt(struct phy_device *phydev)
149*4882a593Smuzhiyun {
150*4882a593Smuzhiyun 	/* bit[7..0] int status, which is a read and clear register. */
151*4882a593Smuzhiyun 	int rc;
152*4882a593Smuzhiyun 
153*4882a593Smuzhiyun 	rc = phy_read(phydev, MII_KSZPHY_INTCS);
154*4882a593Smuzhiyun 
155*4882a593Smuzhiyun 	return (rc < 0) ? rc : 0;
156*4882a593Smuzhiyun }
157*4882a593Smuzhiyun 
kszphy_config_intr(struct phy_device * phydev)158*4882a593Smuzhiyun static int kszphy_config_intr(struct phy_device *phydev)
159*4882a593Smuzhiyun {
160*4882a593Smuzhiyun 	const struct kszphy_type *type = phydev->drv->driver_data;
161*4882a593Smuzhiyun 	int temp;
162*4882a593Smuzhiyun 	u16 mask;
163*4882a593Smuzhiyun 
164*4882a593Smuzhiyun 	if (type && type->interrupt_level_mask)
165*4882a593Smuzhiyun 		mask = type->interrupt_level_mask;
166*4882a593Smuzhiyun 	else
167*4882a593Smuzhiyun 		mask = KSZPHY_CTRL_INT_ACTIVE_HIGH;
168*4882a593Smuzhiyun 
169*4882a593Smuzhiyun 	/* set the interrupt pin active low */
170*4882a593Smuzhiyun 	temp = phy_read(phydev, MII_KSZPHY_CTRL);
171*4882a593Smuzhiyun 	if (temp < 0)
172*4882a593Smuzhiyun 		return temp;
173*4882a593Smuzhiyun 	temp &= ~mask;
174*4882a593Smuzhiyun 	phy_write(phydev, MII_KSZPHY_CTRL, temp);
175*4882a593Smuzhiyun 
176*4882a593Smuzhiyun 	/* enable / disable interrupts */
177*4882a593Smuzhiyun 	if (phydev->interrupts == PHY_INTERRUPT_ENABLED)
178*4882a593Smuzhiyun 		temp = KSZPHY_INTCS_ALL;
179*4882a593Smuzhiyun 	else
180*4882a593Smuzhiyun 		temp = 0;
181*4882a593Smuzhiyun 
182*4882a593Smuzhiyun 	return phy_write(phydev, MII_KSZPHY_INTCS, temp);
183*4882a593Smuzhiyun }
184*4882a593Smuzhiyun 
kszphy_rmii_clk_sel(struct phy_device * phydev,bool val)185*4882a593Smuzhiyun static int kszphy_rmii_clk_sel(struct phy_device *phydev, bool val)
186*4882a593Smuzhiyun {
187*4882a593Smuzhiyun 	int ctrl;
188*4882a593Smuzhiyun 
189*4882a593Smuzhiyun 	ctrl = phy_read(phydev, MII_KSZPHY_CTRL);
190*4882a593Smuzhiyun 	if (ctrl < 0)
191*4882a593Smuzhiyun 		return ctrl;
192*4882a593Smuzhiyun 
193*4882a593Smuzhiyun 	if (val)
194*4882a593Smuzhiyun 		ctrl |= KSZPHY_RMII_REF_CLK_SEL;
195*4882a593Smuzhiyun 	else
196*4882a593Smuzhiyun 		ctrl &= ~KSZPHY_RMII_REF_CLK_SEL;
197*4882a593Smuzhiyun 
198*4882a593Smuzhiyun 	return phy_write(phydev, MII_KSZPHY_CTRL, ctrl);
199*4882a593Smuzhiyun }
200*4882a593Smuzhiyun 
kszphy_setup_led(struct phy_device * phydev,u32 reg,int val)201*4882a593Smuzhiyun static int kszphy_setup_led(struct phy_device *phydev, u32 reg, int val)
202*4882a593Smuzhiyun {
203*4882a593Smuzhiyun 	int rc, temp, shift;
204*4882a593Smuzhiyun 
205*4882a593Smuzhiyun 	switch (reg) {
206*4882a593Smuzhiyun 	case MII_KSZPHY_CTRL_1:
207*4882a593Smuzhiyun 		shift = 14;
208*4882a593Smuzhiyun 		break;
209*4882a593Smuzhiyun 	case MII_KSZPHY_CTRL_2:
210*4882a593Smuzhiyun 		shift = 4;
211*4882a593Smuzhiyun 		break;
212*4882a593Smuzhiyun 	default:
213*4882a593Smuzhiyun 		return -EINVAL;
214*4882a593Smuzhiyun 	}
215*4882a593Smuzhiyun 
216*4882a593Smuzhiyun 	temp = phy_read(phydev, reg);
217*4882a593Smuzhiyun 	if (temp < 0) {
218*4882a593Smuzhiyun 		rc = temp;
219*4882a593Smuzhiyun 		goto out;
220*4882a593Smuzhiyun 	}
221*4882a593Smuzhiyun 
222*4882a593Smuzhiyun 	temp &= ~(3 << shift);
223*4882a593Smuzhiyun 	temp |= val << shift;
224*4882a593Smuzhiyun 	rc = phy_write(phydev, reg, temp);
225*4882a593Smuzhiyun out:
226*4882a593Smuzhiyun 	if (rc < 0)
227*4882a593Smuzhiyun 		phydev_err(phydev, "failed to set led mode\n");
228*4882a593Smuzhiyun 
229*4882a593Smuzhiyun 	return rc;
230*4882a593Smuzhiyun }
231*4882a593Smuzhiyun 
232*4882a593Smuzhiyun /* Disable PHY address 0 as the broadcast address, so that it can be used as a
233*4882a593Smuzhiyun  * unique (non-broadcast) address on a shared bus.
234*4882a593Smuzhiyun  */
kszphy_broadcast_disable(struct phy_device * phydev)235*4882a593Smuzhiyun static int kszphy_broadcast_disable(struct phy_device *phydev)
236*4882a593Smuzhiyun {
237*4882a593Smuzhiyun 	int ret;
238*4882a593Smuzhiyun 
239*4882a593Smuzhiyun 	ret = phy_read(phydev, MII_KSZPHY_OMSO);
240*4882a593Smuzhiyun 	if (ret < 0)
241*4882a593Smuzhiyun 		goto out;
242*4882a593Smuzhiyun 
243*4882a593Smuzhiyun 	ret = phy_write(phydev, MII_KSZPHY_OMSO, ret | KSZPHY_OMSO_B_CAST_OFF);
244*4882a593Smuzhiyun out:
245*4882a593Smuzhiyun 	if (ret)
246*4882a593Smuzhiyun 		phydev_err(phydev, "failed to disable broadcast address\n");
247*4882a593Smuzhiyun 
248*4882a593Smuzhiyun 	return ret;
249*4882a593Smuzhiyun }
250*4882a593Smuzhiyun 
kszphy_nand_tree_disable(struct phy_device * phydev)251*4882a593Smuzhiyun static int kszphy_nand_tree_disable(struct phy_device *phydev)
252*4882a593Smuzhiyun {
253*4882a593Smuzhiyun 	int ret;
254*4882a593Smuzhiyun 
255*4882a593Smuzhiyun 	ret = phy_read(phydev, MII_KSZPHY_OMSO);
256*4882a593Smuzhiyun 	if (ret < 0)
257*4882a593Smuzhiyun 		goto out;
258*4882a593Smuzhiyun 
259*4882a593Smuzhiyun 	if (!(ret & KSZPHY_OMSO_NAND_TREE_ON))
260*4882a593Smuzhiyun 		return 0;
261*4882a593Smuzhiyun 
262*4882a593Smuzhiyun 	ret = phy_write(phydev, MII_KSZPHY_OMSO,
263*4882a593Smuzhiyun 			ret & ~KSZPHY_OMSO_NAND_TREE_ON);
264*4882a593Smuzhiyun out:
265*4882a593Smuzhiyun 	if (ret)
266*4882a593Smuzhiyun 		phydev_err(phydev, "failed to disable NAND tree mode\n");
267*4882a593Smuzhiyun 
268*4882a593Smuzhiyun 	return ret;
269*4882a593Smuzhiyun }
270*4882a593Smuzhiyun 
271*4882a593Smuzhiyun /* Some config bits need to be set again on resume, handle them here. */
kszphy_config_reset(struct phy_device * phydev)272*4882a593Smuzhiyun static int kszphy_config_reset(struct phy_device *phydev)
273*4882a593Smuzhiyun {
274*4882a593Smuzhiyun 	struct kszphy_priv *priv = phydev->priv;
275*4882a593Smuzhiyun 	int ret;
276*4882a593Smuzhiyun 
277*4882a593Smuzhiyun 	if (priv->rmii_ref_clk_sel) {
278*4882a593Smuzhiyun 		ret = kszphy_rmii_clk_sel(phydev, priv->rmii_ref_clk_sel_val);
279*4882a593Smuzhiyun 		if (ret) {
280*4882a593Smuzhiyun 			phydev_err(phydev,
281*4882a593Smuzhiyun 				   "failed to set rmii reference clock\n");
282*4882a593Smuzhiyun 			return ret;
283*4882a593Smuzhiyun 		}
284*4882a593Smuzhiyun 	}
285*4882a593Smuzhiyun 
286*4882a593Smuzhiyun 	if (priv->type && priv->led_mode >= 0)
287*4882a593Smuzhiyun 		kszphy_setup_led(phydev, priv->type->led_mode_reg, priv->led_mode);
288*4882a593Smuzhiyun 
289*4882a593Smuzhiyun 	return 0;
290*4882a593Smuzhiyun }
291*4882a593Smuzhiyun 
kszphy_config_init(struct phy_device * phydev)292*4882a593Smuzhiyun static int kszphy_config_init(struct phy_device *phydev)
293*4882a593Smuzhiyun {
294*4882a593Smuzhiyun 	struct kszphy_priv *priv = phydev->priv;
295*4882a593Smuzhiyun 	const struct kszphy_type *type;
296*4882a593Smuzhiyun 
297*4882a593Smuzhiyun 	if (!priv)
298*4882a593Smuzhiyun 		return 0;
299*4882a593Smuzhiyun 
300*4882a593Smuzhiyun 	type = priv->type;
301*4882a593Smuzhiyun 
302*4882a593Smuzhiyun 	if (type && type->has_broadcast_disable)
303*4882a593Smuzhiyun 		kszphy_broadcast_disable(phydev);
304*4882a593Smuzhiyun 
305*4882a593Smuzhiyun 	if (type && type->has_nand_tree_disable)
306*4882a593Smuzhiyun 		kszphy_nand_tree_disable(phydev);
307*4882a593Smuzhiyun 
308*4882a593Smuzhiyun 	return kszphy_config_reset(phydev);
309*4882a593Smuzhiyun }
310*4882a593Smuzhiyun 
ksz8041_fiber_mode(struct phy_device * phydev)311*4882a593Smuzhiyun static int ksz8041_fiber_mode(struct phy_device *phydev)
312*4882a593Smuzhiyun {
313*4882a593Smuzhiyun 	struct device_node *of_node = phydev->mdio.dev.of_node;
314*4882a593Smuzhiyun 
315*4882a593Smuzhiyun 	return of_property_read_bool(of_node, "micrel,fiber-mode");
316*4882a593Smuzhiyun }
317*4882a593Smuzhiyun 
ksz8041_config_init(struct phy_device * phydev)318*4882a593Smuzhiyun static int ksz8041_config_init(struct phy_device *phydev)
319*4882a593Smuzhiyun {
320*4882a593Smuzhiyun 	__ETHTOOL_DECLARE_LINK_MODE_MASK(mask) = { 0, };
321*4882a593Smuzhiyun 
322*4882a593Smuzhiyun 	/* Limit supported and advertised modes in fiber mode */
323*4882a593Smuzhiyun 	if (ksz8041_fiber_mode(phydev)) {
324*4882a593Smuzhiyun 		phydev->dev_flags |= MICREL_PHY_FXEN;
325*4882a593Smuzhiyun 		linkmode_set_bit(ETHTOOL_LINK_MODE_100baseT_Full_BIT, mask);
326*4882a593Smuzhiyun 		linkmode_set_bit(ETHTOOL_LINK_MODE_100baseT_Half_BIT, mask);
327*4882a593Smuzhiyun 
328*4882a593Smuzhiyun 		linkmode_and(phydev->supported, phydev->supported, mask);
329*4882a593Smuzhiyun 		linkmode_set_bit(ETHTOOL_LINK_MODE_FIBRE_BIT,
330*4882a593Smuzhiyun 				 phydev->supported);
331*4882a593Smuzhiyun 		linkmode_and(phydev->advertising, phydev->advertising, mask);
332*4882a593Smuzhiyun 		linkmode_set_bit(ETHTOOL_LINK_MODE_FIBRE_BIT,
333*4882a593Smuzhiyun 				 phydev->advertising);
334*4882a593Smuzhiyun 		phydev->autoneg = AUTONEG_DISABLE;
335*4882a593Smuzhiyun 	}
336*4882a593Smuzhiyun 
337*4882a593Smuzhiyun 	return kszphy_config_init(phydev);
338*4882a593Smuzhiyun }
339*4882a593Smuzhiyun 
ksz8041_config_aneg(struct phy_device * phydev)340*4882a593Smuzhiyun static int ksz8041_config_aneg(struct phy_device *phydev)
341*4882a593Smuzhiyun {
342*4882a593Smuzhiyun 	/* Skip auto-negotiation in fiber mode */
343*4882a593Smuzhiyun 	if (phydev->dev_flags & MICREL_PHY_FXEN) {
344*4882a593Smuzhiyun 		phydev->speed = SPEED_100;
345*4882a593Smuzhiyun 		return 0;
346*4882a593Smuzhiyun 	}
347*4882a593Smuzhiyun 
348*4882a593Smuzhiyun 	return genphy_config_aneg(phydev);
349*4882a593Smuzhiyun }
350*4882a593Smuzhiyun 
ksz8051_ksz8795_match_phy_device(struct phy_device * phydev,const bool ksz_8051)351*4882a593Smuzhiyun static int ksz8051_ksz8795_match_phy_device(struct phy_device *phydev,
352*4882a593Smuzhiyun 					    const bool ksz_8051)
353*4882a593Smuzhiyun {
354*4882a593Smuzhiyun 	int ret;
355*4882a593Smuzhiyun 
356*4882a593Smuzhiyun 	if ((phydev->phy_id & MICREL_PHY_ID_MASK) != PHY_ID_KSZ8051)
357*4882a593Smuzhiyun 		return 0;
358*4882a593Smuzhiyun 
359*4882a593Smuzhiyun 	ret = phy_read(phydev, MII_BMSR);
360*4882a593Smuzhiyun 	if (ret < 0)
361*4882a593Smuzhiyun 		return ret;
362*4882a593Smuzhiyun 
363*4882a593Smuzhiyun 	/* KSZ8051 PHY and KSZ8794/KSZ8795/KSZ8765 switch share the same
364*4882a593Smuzhiyun 	 * exact PHY ID. However, they can be told apart by the extended
365*4882a593Smuzhiyun 	 * capability registers presence. The KSZ8051 PHY has them while
366*4882a593Smuzhiyun 	 * the switch does not.
367*4882a593Smuzhiyun 	 */
368*4882a593Smuzhiyun 	ret &= BMSR_ERCAP;
369*4882a593Smuzhiyun 	if (ksz_8051)
370*4882a593Smuzhiyun 		return ret;
371*4882a593Smuzhiyun 	else
372*4882a593Smuzhiyun 		return !ret;
373*4882a593Smuzhiyun }
374*4882a593Smuzhiyun 
ksz8051_match_phy_device(struct phy_device * phydev)375*4882a593Smuzhiyun static int ksz8051_match_phy_device(struct phy_device *phydev)
376*4882a593Smuzhiyun {
377*4882a593Smuzhiyun 	return ksz8051_ksz8795_match_phy_device(phydev, true);
378*4882a593Smuzhiyun }
379*4882a593Smuzhiyun 
ksz8081_config_init(struct phy_device * phydev)380*4882a593Smuzhiyun static int ksz8081_config_init(struct phy_device *phydev)
381*4882a593Smuzhiyun {
382*4882a593Smuzhiyun 	/* KSZPHY_OMSO_FACTORY_TEST is set at de-assertion of the reset line
383*4882a593Smuzhiyun 	 * based on the RXER (KSZ8081RNA/RND) or TXC (KSZ8081MNX/RNB) pin. If a
384*4882a593Smuzhiyun 	 * pull-down is missing, the factory test mode should be cleared by
385*4882a593Smuzhiyun 	 * manually writing a 0.
386*4882a593Smuzhiyun 	 */
387*4882a593Smuzhiyun 	phy_clear_bits(phydev, MII_KSZPHY_OMSO, KSZPHY_OMSO_FACTORY_TEST);
388*4882a593Smuzhiyun 
389*4882a593Smuzhiyun 	return kszphy_config_init(phydev);
390*4882a593Smuzhiyun }
391*4882a593Smuzhiyun 
ksz8061_config_init(struct phy_device * phydev)392*4882a593Smuzhiyun static int ksz8061_config_init(struct phy_device *phydev)
393*4882a593Smuzhiyun {
394*4882a593Smuzhiyun 	int ret;
395*4882a593Smuzhiyun 
396*4882a593Smuzhiyun 	ret = phy_write_mmd(phydev, MDIO_MMD_PMAPMD, MDIO_DEVID1, 0xB61A);
397*4882a593Smuzhiyun 	if (ret)
398*4882a593Smuzhiyun 		return ret;
399*4882a593Smuzhiyun 
400*4882a593Smuzhiyun 	return kszphy_config_init(phydev);
401*4882a593Smuzhiyun }
402*4882a593Smuzhiyun 
ksz8795_match_phy_device(struct phy_device * phydev)403*4882a593Smuzhiyun static int ksz8795_match_phy_device(struct phy_device *phydev)
404*4882a593Smuzhiyun {
405*4882a593Smuzhiyun 	return ksz8051_ksz8795_match_phy_device(phydev, false);
406*4882a593Smuzhiyun }
407*4882a593Smuzhiyun 
ksz9021_load_values_from_of(struct phy_device * phydev,const struct device_node * of_node,u16 reg,const char * field1,const char * field2,const char * field3,const char * field4)408*4882a593Smuzhiyun static int ksz9021_load_values_from_of(struct phy_device *phydev,
409*4882a593Smuzhiyun 				       const struct device_node *of_node,
410*4882a593Smuzhiyun 				       u16 reg,
411*4882a593Smuzhiyun 				       const char *field1, const char *field2,
412*4882a593Smuzhiyun 				       const char *field3, const char *field4)
413*4882a593Smuzhiyun {
414*4882a593Smuzhiyun 	int val1 = -1;
415*4882a593Smuzhiyun 	int val2 = -2;
416*4882a593Smuzhiyun 	int val3 = -3;
417*4882a593Smuzhiyun 	int val4 = -4;
418*4882a593Smuzhiyun 	int newval;
419*4882a593Smuzhiyun 	int matches = 0;
420*4882a593Smuzhiyun 
421*4882a593Smuzhiyun 	if (!of_property_read_u32(of_node, field1, &val1))
422*4882a593Smuzhiyun 		matches++;
423*4882a593Smuzhiyun 
424*4882a593Smuzhiyun 	if (!of_property_read_u32(of_node, field2, &val2))
425*4882a593Smuzhiyun 		matches++;
426*4882a593Smuzhiyun 
427*4882a593Smuzhiyun 	if (!of_property_read_u32(of_node, field3, &val3))
428*4882a593Smuzhiyun 		matches++;
429*4882a593Smuzhiyun 
430*4882a593Smuzhiyun 	if (!of_property_read_u32(of_node, field4, &val4))
431*4882a593Smuzhiyun 		matches++;
432*4882a593Smuzhiyun 
433*4882a593Smuzhiyun 	if (!matches)
434*4882a593Smuzhiyun 		return 0;
435*4882a593Smuzhiyun 
436*4882a593Smuzhiyun 	if (matches < 4)
437*4882a593Smuzhiyun 		newval = kszphy_extended_read(phydev, reg);
438*4882a593Smuzhiyun 	else
439*4882a593Smuzhiyun 		newval = 0;
440*4882a593Smuzhiyun 
441*4882a593Smuzhiyun 	if (val1 != -1)
442*4882a593Smuzhiyun 		newval = ((newval & 0xfff0) | ((val1 / PS_TO_REG) & 0xf) << 0);
443*4882a593Smuzhiyun 
444*4882a593Smuzhiyun 	if (val2 != -2)
445*4882a593Smuzhiyun 		newval = ((newval & 0xff0f) | ((val2 / PS_TO_REG) & 0xf) << 4);
446*4882a593Smuzhiyun 
447*4882a593Smuzhiyun 	if (val3 != -3)
448*4882a593Smuzhiyun 		newval = ((newval & 0xf0ff) | ((val3 / PS_TO_REG) & 0xf) << 8);
449*4882a593Smuzhiyun 
450*4882a593Smuzhiyun 	if (val4 != -4)
451*4882a593Smuzhiyun 		newval = ((newval & 0x0fff) | ((val4 / PS_TO_REG) & 0xf) << 12);
452*4882a593Smuzhiyun 
453*4882a593Smuzhiyun 	return kszphy_extended_write(phydev, reg, newval);
454*4882a593Smuzhiyun }
455*4882a593Smuzhiyun 
ksz9021_config_init(struct phy_device * phydev)456*4882a593Smuzhiyun static int ksz9021_config_init(struct phy_device *phydev)
457*4882a593Smuzhiyun {
458*4882a593Smuzhiyun 	const struct device *dev = &phydev->mdio.dev;
459*4882a593Smuzhiyun 	const struct device_node *of_node = dev->of_node;
460*4882a593Smuzhiyun 	const struct device *dev_walker;
461*4882a593Smuzhiyun 
462*4882a593Smuzhiyun 	/* The Micrel driver has a deprecated option to place phy OF
463*4882a593Smuzhiyun 	 * properties in the MAC node. Walk up the tree of devices to
464*4882a593Smuzhiyun 	 * find a device with an OF node.
465*4882a593Smuzhiyun 	 */
466*4882a593Smuzhiyun 	dev_walker = &phydev->mdio.dev;
467*4882a593Smuzhiyun 	do {
468*4882a593Smuzhiyun 		of_node = dev_walker->of_node;
469*4882a593Smuzhiyun 		dev_walker = dev_walker->parent;
470*4882a593Smuzhiyun 
471*4882a593Smuzhiyun 	} while (!of_node && dev_walker);
472*4882a593Smuzhiyun 
473*4882a593Smuzhiyun 	if (of_node) {
474*4882a593Smuzhiyun 		ksz9021_load_values_from_of(phydev, of_node,
475*4882a593Smuzhiyun 				    MII_KSZPHY_CLK_CONTROL_PAD_SKEW,
476*4882a593Smuzhiyun 				    "txen-skew-ps", "txc-skew-ps",
477*4882a593Smuzhiyun 				    "rxdv-skew-ps", "rxc-skew-ps");
478*4882a593Smuzhiyun 		ksz9021_load_values_from_of(phydev, of_node,
479*4882a593Smuzhiyun 				    MII_KSZPHY_RX_DATA_PAD_SKEW,
480*4882a593Smuzhiyun 				    "rxd0-skew-ps", "rxd1-skew-ps",
481*4882a593Smuzhiyun 				    "rxd2-skew-ps", "rxd3-skew-ps");
482*4882a593Smuzhiyun 		ksz9021_load_values_from_of(phydev, of_node,
483*4882a593Smuzhiyun 				    MII_KSZPHY_TX_DATA_PAD_SKEW,
484*4882a593Smuzhiyun 				    "txd0-skew-ps", "txd1-skew-ps",
485*4882a593Smuzhiyun 				    "txd2-skew-ps", "txd3-skew-ps");
486*4882a593Smuzhiyun 	}
487*4882a593Smuzhiyun 	return 0;
488*4882a593Smuzhiyun }
489*4882a593Smuzhiyun 
490*4882a593Smuzhiyun #define KSZ9031_PS_TO_REG		60
491*4882a593Smuzhiyun 
492*4882a593Smuzhiyun /* Extended registers */
493*4882a593Smuzhiyun /* MMD Address 0x0 */
494*4882a593Smuzhiyun #define MII_KSZ9031RN_FLP_BURST_TX_LO	3
495*4882a593Smuzhiyun #define MII_KSZ9031RN_FLP_BURST_TX_HI	4
496*4882a593Smuzhiyun 
497*4882a593Smuzhiyun /* MMD Address 0x2 */
498*4882a593Smuzhiyun #define MII_KSZ9031RN_CONTROL_PAD_SKEW	4
499*4882a593Smuzhiyun #define MII_KSZ9031RN_RX_CTL_M		GENMASK(7, 4)
500*4882a593Smuzhiyun #define MII_KSZ9031RN_TX_CTL_M		GENMASK(3, 0)
501*4882a593Smuzhiyun 
502*4882a593Smuzhiyun #define MII_KSZ9031RN_RX_DATA_PAD_SKEW	5
503*4882a593Smuzhiyun #define MII_KSZ9031RN_RXD3		GENMASK(15, 12)
504*4882a593Smuzhiyun #define MII_KSZ9031RN_RXD2		GENMASK(11, 8)
505*4882a593Smuzhiyun #define MII_KSZ9031RN_RXD1		GENMASK(7, 4)
506*4882a593Smuzhiyun #define MII_KSZ9031RN_RXD0		GENMASK(3, 0)
507*4882a593Smuzhiyun 
508*4882a593Smuzhiyun #define MII_KSZ9031RN_TX_DATA_PAD_SKEW	6
509*4882a593Smuzhiyun #define MII_KSZ9031RN_TXD3		GENMASK(15, 12)
510*4882a593Smuzhiyun #define MII_KSZ9031RN_TXD2		GENMASK(11, 8)
511*4882a593Smuzhiyun #define MII_KSZ9031RN_TXD1		GENMASK(7, 4)
512*4882a593Smuzhiyun #define MII_KSZ9031RN_TXD0		GENMASK(3, 0)
513*4882a593Smuzhiyun 
514*4882a593Smuzhiyun #define MII_KSZ9031RN_CLK_PAD_SKEW	8
515*4882a593Smuzhiyun #define MII_KSZ9031RN_GTX_CLK		GENMASK(9, 5)
516*4882a593Smuzhiyun #define MII_KSZ9031RN_RX_CLK		GENMASK(4, 0)
517*4882a593Smuzhiyun 
518*4882a593Smuzhiyun /* KSZ9031 has internal RGMII_IDRX = 1.2ns and RGMII_IDTX = 0ns. To
519*4882a593Smuzhiyun  * provide different RGMII options we need to configure delay offset
520*4882a593Smuzhiyun  * for each pad relative to build in delay.
521*4882a593Smuzhiyun  */
522*4882a593Smuzhiyun /* keep rx as "No delay adjustment" and set rx_clk to +0.60ns to get delays of
523*4882a593Smuzhiyun  * 1.80ns
524*4882a593Smuzhiyun  */
525*4882a593Smuzhiyun #define RX_ID				0x7
526*4882a593Smuzhiyun #define RX_CLK_ID			0x19
527*4882a593Smuzhiyun 
528*4882a593Smuzhiyun /* set rx to +0.30ns and rx_clk to -0.90ns to compensate the
529*4882a593Smuzhiyun  * internal 1.2ns delay.
530*4882a593Smuzhiyun  */
531*4882a593Smuzhiyun #define RX_ND				0xc
532*4882a593Smuzhiyun #define RX_CLK_ND			0x0
533*4882a593Smuzhiyun 
534*4882a593Smuzhiyun /* set tx to -0.42ns and tx_clk to +0.96ns to get 1.38ns delay */
535*4882a593Smuzhiyun #define TX_ID				0x0
536*4882a593Smuzhiyun #define TX_CLK_ID			0x1f
537*4882a593Smuzhiyun 
538*4882a593Smuzhiyun /* set tx and tx_clk to "No delay adjustment" to keep 0ns
539*4882a593Smuzhiyun  * dealy
540*4882a593Smuzhiyun  */
541*4882a593Smuzhiyun #define TX_ND				0x7
542*4882a593Smuzhiyun #define TX_CLK_ND			0xf
543*4882a593Smuzhiyun 
544*4882a593Smuzhiyun /* MMD Address 0x1C */
545*4882a593Smuzhiyun #define MII_KSZ9031RN_EDPD		0x23
546*4882a593Smuzhiyun #define MII_KSZ9031RN_EDPD_ENABLE	BIT(0)
547*4882a593Smuzhiyun 
ksz9031_of_load_skew_values(struct phy_device * phydev,const struct device_node * of_node,u16 reg,size_t field_sz,const char * field[],u8 numfields,bool * update)548*4882a593Smuzhiyun static int ksz9031_of_load_skew_values(struct phy_device *phydev,
549*4882a593Smuzhiyun 				       const struct device_node *of_node,
550*4882a593Smuzhiyun 				       u16 reg, size_t field_sz,
551*4882a593Smuzhiyun 				       const char *field[], u8 numfields,
552*4882a593Smuzhiyun 				       bool *update)
553*4882a593Smuzhiyun {
554*4882a593Smuzhiyun 	int val[4] = {-1, -2, -3, -4};
555*4882a593Smuzhiyun 	int matches = 0;
556*4882a593Smuzhiyun 	u16 mask;
557*4882a593Smuzhiyun 	u16 maxval;
558*4882a593Smuzhiyun 	u16 newval;
559*4882a593Smuzhiyun 	int i;
560*4882a593Smuzhiyun 
561*4882a593Smuzhiyun 	for (i = 0; i < numfields; i++)
562*4882a593Smuzhiyun 		if (!of_property_read_u32(of_node, field[i], val + i))
563*4882a593Smuzhiyun 			matches++;
564*4882a593Smuzhiyun 
565*4882a593Smuzhiyun 	if (!matches)
566*4882a593Smuzhiyun 		return 0;
567*4882a593Smuzhiyun 
568*4882a593Smuzhiyun 	*update |= true;
569*4882a593Smuzhiyun 
570*4882a593Smuzhiyun 	if (matches < numfields)
571*4882a593Smuzhiyun 		newval = phy_read_mmd(phydev, 2, reg);
572*4882a593Smuzhiyun 	else
573*4882a593Smuzhiyun 		newval = 0;
574*4882a593Smuzhiyun 
575*4882a593Smuzhiyun 	maxval = (field_sz == 4) ? 0xf : 0x1f;
576*4882a593Smuzhiyun 	for (i = 0; i < numfields; i++)
577*4882a593Smuzhiyun 		if (val[i] != -(i + 1)) {
578*4882a593Smuzhiyun 			mask = 0xffff;
579*4882a593Smuzhiyun 			mask ^= maxval << (field_sz * i);
580*4882a593Smuzhiyun 			newval = (newval & mask) |
581*4882a593Smuzhiyun 				(((val[i] / KSZ9031_PS_TO_REG) & maxval)
582*4882a593Smuzhiyun 					<< (field_sz * i));
583*4882a593Smuzhiyun 		}
584*4882a593Smuzhiyun 
585*4882a593Smuzhiyun 	return phy_write_mmd(phydev, 2, reg, newval);
586*4882a593Smuzhiyun }
587*4882a593Smuzhiyun 
588*4882a593Smuzhiyun /* Center KSZ9031RNX FLP timing at 16ms. */
ksz9031_center_flp_timing(struct phy_device * phydev)589*4882a593Smuzhiyun static int ksz9031_center_flp_timing(struct phy_device *phydev)
590*4882a593Smuzhiyun {
591*4882a593Smuzhiyun 	int result;
592*4882a593Smuzhiyun 
593*4882a593Smuzhiyun 	result = phy_write_mmd(phydev, 0, MII_KSZ9031RN_FLP_BURST_TX_HI,
594*4882a593Smuzhiyun 			       0x0006);
595*4882a593Smuzhiyun 	if (result)
596*4882a593Smuzhiyun 		return result;
597*4882a593Smuzhiyun 
598*4882a593Smuzhiyun 	result = phy_write_mmd(phydev, 0, MII_KSZ9031RN_FLP_BURST_TX_LO,
599*4882a593Smuzhiyun 			       0x1A80);
600*4882a593Smuzhiyun 	if (result)
601*4882a593Smuzhiyun 		return result;
602*4882a593Smuzhiyun 
603*4882a593Smuzhiyun 	return genphy_restart_aneg(phydev);
604*4882a593Smuzhiyun }
605*4882a593Smuzhiyun 
606*4882a593Smuzhiyun /* Enable energy-detect power-down mode */
ksz9031_enable_edpd(struct phy_device * phydev)607*4882a593Smuzhiyun static int ksz9031_enable_edpd(struct phy_device *phydev)
608*4882a593Smuzhiyun {
609*4882a593Smuzhiyun 	int reg;
610*4882a593Smuzhiyun 
611*4882a593Smuzhiyun 	reg = phy_read_mmd(phydev, 0x1C, MII_KSZ9031RN_EDPD);
612*4882a593Smuzhiyun 	if (reg < 0)
613*4882a593Smuzhiyun 		return reg;
614*4882a593Smuzhiyun 	return phy_write_mmd(phydev, 0x1C, MII_KSZ9031RN_EDPD,
615*4882a593Smuzhiyun 			     reg | MII_KSZ9031RN_EDPD_ENABLE);
616*4882a593Smuzhiyun }
617*4882a593Smuzhiyun 
ksz9031_config_rgmii_delay(struct phy_device * phydev)618*4882a593Smuzhiyun static int ksz9031_config_rgmii_delay(struct phy_device *phydev)
619*4882a593Smuzhiyun {
620*4882a593Smuzhiyun 	u16 rx, tx, rx_clk, tx_clk;
621*4882a593Smuzhiyun 	int ret;
622*4882a593Smuzhiyun 
623*4882a593Smuzhiyun 	switch (phydev->interface) {
624*4882a593Smuzhiyun 	case PHY_INTERFACE_MODE_RGMII:
625*4882a593Smuzhiyun 		tx = TX_ND;
626*4882a593Smuzhiyun 		tx_clk = TX_CLK_ND;
627*4882a593Smuzhiyun 		rx = RX_ND;
628*4882a593Smuzhiyun 		rx_clk = RX_CLK_ND;
629*4882a593Smuzhiyun 		break;
630*4882a593Smuzhiyun 	case PHY_INTERFACE_MODE_RGMII_ID:
631*4882a593Smuzhiyun 		tx = TX_ID;
632*4882a593Smuzhiyun 		tx_clk = TX_CLK_ID;
633*4882a593Smuzhiyun 		rx = RX_ID;
634*4882a593Smuzhiyun 		rx_clk = RX_CLK_ID;
635*4882a593Smuzhiyun 		break;
636*4882a593Smuzhiyun 	case PHY_INTERFACE_MODE_RGMII_RXID:
637*4882a593Smuzhiyun 		tx = TX_ND;
638*4882a593Smuzhiyun 		tx_clk = TX_CLK_ND;
639*4882a593Smuzhiyun 		rx = RX_ID;
640*4882a593Smuzhiyun 		rx_clk = RX_CLK_ID;
641*4882a593Smuzhiyun 		break;
642*4882a593Smuzhiyun 	case PHY_INTERFACE_MODE_RGMII_TXID:
643*4882a593Smuzhiyun 		tx = TX_ID;
644*4882a593Smuzhiyun 		tx_clk = TX_CLK_ID;
645*4882a593Smuzhiyun 		rx = RX_ND;
646*4882a593Smuzhiyun 		rx_clk = RX_CLK_ND;
647*4882a593Smuzhiyun 		break;
648*4882a593Smuzhiyun 	default:
649*4882a593Smuzhiyun 		return 0;
650*4882a593Smuzhiyun 	}
651*4882a593Smuzhiyun 
652*4882a593Smuzhiyun 	ret = phy_write_mmd(phydev, 2, MII_KSZ9031RN_CONTROL_PAD_SKEW,
653*4882a593Smuzhiyun 			    FIELD_PREP(MII_KSZ9031RN_RX_CTL_M, rx) |
654*4882a593Smuzhiyun 			    FIELD_PREP(MII_KSZ9031RN_TX_CTL_M, tx));
655*4882a593Smuzhiyun 	if (ret < 0)
656*4882a593Smuzhiyun 		return ret;
657*4882a593Smuzhiyun 
658*4882a593Smuzhiyun 	ret = phy_write_mmd(phydev, 2, MII_KSZ9031RN_RX_DATA_PAD_SKEW,
659*4882a593Smuzhiyun 			    FIELD_PREP(MII_KSZ9031RN_RXD3, rx) |
660*4882a593Smuzhiyun 			    FIELD_PREP(MII_KSZ9031RN_RXD2, rx) |
661*4882a593Smuzhiyun 			    FIELD_PREP(MII_KSZ9031RN_RXD1, rx) |
662*4882a593Smuzhiyun 			    FIELD_PREP(MII_KSZ9031RN_RXD0, rx));
663*4882a593Smuzhiyun 	if (ret < 0)
664*4882a593Smuzhiyun 		return ret;
665*4882a593Smuzhiyun 
666*4882a593Smuzhiyun 	ret = phy_write_mmd(phydev, 2, MII_KSZ9031RN_TX_DATA_PAD_SKEW,
667*4882a593Smuzhiyun 			    FIELD_PREP(MII_KSZ9031RN_TXD3, tx) |
668*4882a593Smuzhiyun 			    FIELD_PREP(MII_KSZ9031RN_TXD2, tx) |
669*4882a593Smuzhiyun 			    FIELD_PREP(MII_KSZ9031RN_TXD1, tx) |
670*4882a593Smuzhiyun 			    FIELD_PREP(MII_KSZ9031RN_TXD0, tx));
671*4882a593Smuzhiyun 	if (ret < 0)
672*4882a593Smuzhiyun 		return ret;
673*4882a593Smuzhiyun 
674*4882a593Smuzhiyun 	return phy_write_mmd(phydev, 2, MII_KSZ9031RN_CLK_PAD_SKEW,
675*4882a593Smuzhiyun 			     FIELD_PREP(MII_KSZ9031RN_GTX_CLK, tx_clk) |
676*4882a593Smuzhiyun 			     FIELD_PREP(MII_KSZ9031RN_RX_CLK, rx_clk));
677*4882a593Smuzhiyun }
678*4882a593Smuzhiyun 
ksz9031_config_init(struct phy_device * phydev)679*4882a593Smuzhiyun static int ksz9031_config_init(struct phy_device *phydev)
680*4882a593Smuzhiyun {
681*4882a593Smuzhiyun 	const struct device *dev = &phydev->mdio.dev;
682*4882a593Smuzhiyun 	const struct device_node *of_node = dev->of_node;
683*4882a593Smuzhiyun 	static const char *clk_skews[2] = {"rxc-skew-ps", "txc-skew-ps"};
684*4882a593Smuzhiyun 	static const char *rx_data_skews[4] = {
685*4882a593Smuzhiyun 		"rxd0-skew-ps", "rxd1-skew-ps",
686*4882a593Smuzhiyun 		"rxd2-skew-ps", "rxd3-skew-ps"
687*4882a593Smuzhiyun 	};
688*4882a593Smuzhiyun 	static const char *tx_data_skews[4] = {
689*4882a593Smuzhiyun 		"txd0-skew-ps", "txd1-skew-ps",
690*4882a593Smuzhiyun 		"txd2-skew-ps", "txd3-skew-ps"
691*4882a593Smuzhiyun 	};
692*4882a593Smuzhiyun 	static const char *control_skews[2] = {"txen-skew-ps", "rxdv-skew-ps"};
693*4882a593Smuzhiyun 	const struct device *dev_walker;
694*4882a593Smuzhiyun 	int result;
695*4882a593Smuzhiyun 
696*4882a593Smuzhiyun 	result = ksz9031_enable_edpd(phydev);
697*4882a593Smuzhiyun 	if (result < 0)
698*4882a593Smuzhiyun 		return result;
699*4882a593Smuzhiyun 
700*4882a593Smuzhiyun 	/* The Micrel driver has a deprecated option to place phy OF
701*4882a593Smuzhiyun 	 * properties in the MAC node. Walk up the tree of devices to
702*4882a593Smuzhiyun 	 * find a device with an OF node.
703*4882a593Smuzhiyun 	 */
704*4882a593Smuzhiyun 	dev_walker = &phydev->mdio.dev;
705*4882a593Smuzhiyun 	do {
706*4882a593Smuzhiyun 		of_node = dev_walker->of_node;
707*4882a593Smuzhiyun 		dev_walker = dev_walker->parent;
708*4882a593Smuzhiyun 	} while (!of_node && dev_walker);
709*4882a593Smuzhiyun 
710*4882a593Smuzhiyun 	if (of_node) {
711*4882a593Smuzhiyun 		bool update = false;
712*4882a593Smuzhiyun 
713*4882a593Smuzhiyun 		if (phy_interface_is_rgmii(phydev)) {
714*4882a593Smuzhiyun 			result = ksz9031_config_rgmii_delay(phydev);
715*4882a593Smuzhiyun 			if (result < 0)
716*4882a593Smuzhiyun 				return result;
717*4882a593Smuzhiyun 		}
718*4882a593Smuzhiyun 
719*4882a593Smuzhiyun 		ksz9031_of_load_skew_values(phydev, of_node,
720*4882a593Smuzhiyun 				MII_KSZ9031RN_CLK_PAD_SKEW, 5,
721*4882a593Smuzhiyun 				clk_skews, 2, &update);
722*4882a593Smuzhiyun 
723*4882a593Smuzhiyun 		ksz9031_of_load_skew_values(phydev, of_node,
724*4882a593Smuzhiyun 				MII_KSZ9031RN_CONTROL_PAD_SKEW, 4,
725*4882a593Smuzhiyun 				control_skews, 2, &update);
726*4882a593Smuzhiyun 
727*4882a593Smuzhiyun 		ksz9031_of_load_skew_values(phydev, of_node,
728*4882a593Smuzhiyun 				MII_KSZ9031RN_RX_DATA_PAD_SKEW, 4,
729*4882a593Smuzhiyun 				rx_data_skews, 4, &update);
730*4882a593Smuzhiyun 
731*4882a593Smuzhiyun 		ksz9031_of_load_skew_values(phydev, of_node,
732*4882a593Smuzhiyun 				MII_KSZ9031RN_TX_DATA_PAD_SKEW, 4,
733*4882a593Smuzhiyun 				tx_data_skews, 4, &update);
734*4882a593Smuzhiyun 
735*4882a593Smuzhiyun 		if (update && !phy_interface_is_rgmii(phydev))
736*4882a593Smuzhiyun 			phydev_warn(phydev,
737*4882a593Smuzhiyun 				    "*-skew-ps values should be used only with RGMII PHY modes\n");
738*4882a593Smuzhiyun 
739*4882a593Smuzhiyun 		/* Silicon Errata Sheet (DS80000691D or DS80000692D):
740*4882a593Smuzhiyun 		 * When the device links in the 1000BASE-T slave mode only,
741*4882a593Smuzhiyun 		 * the optional 125MHz reference output clock (CLK125_NDO)
742*4882a593Smuzhiyun 		 * has wide duty cycle variation.
743*4882a593Smuzhiyun 		 *
744*4882a593Smuzhiyun 		 * The optional CLK125_NDO clock does not meet the RGMII
745*4882a593Smuzhiyun 		 * 45/55 percent (min/max) duty cycle requirement and therefore
746*4882a593Smuzhiyun 		 * cannot be used directly by the MAC side for clocking
747*4882a593Smuzhiyun 		 * applications that have setup/hold time requirements on
748*4882a593Smuzhiyun 		 * rising and falling clock edges.
749*4882a593Smuzhiyun 		 *
750*4882a593Smuzhiyun 		 * Workaround:
751*4882a593Smuzhiyun 		 * Force the phy to be the master to receive a stable clock
752*4882a593Smuzhiyun 		 * which meets the duty cycle requirement.
753*4882a593Smuzhiyun 		 */
754*4882a593Smuzhiyun 		if (of_property_read_bool(of_node, "micrel,force-master")) {
755*4882a593Smuzhiyun 			result = phy_read(phydev, MII_CTRL1000);
756*4882a593Smuzhiyun 			if (result < 0)
757*4882a593Smuzhiyun 				goto err_force_master;
758*4882a593Smuzhiyun 
759*4882a593Smuzhiyun 			/* enable master mode, config & prefer master */
760*4882a593Smuzhiyun 			result |= CTL1000_ENABLE_MASTER | CTL1000_AS_MASTER;
761*4882a593Smuzhiyun 			result = phy_write(phydev, MII_CTRL1000, result);
762*4882a593Smuzhiyun 			if (result < 0)
763*4882a593Smuzhiyun 				goto err_force_master;
764*4882a593Smuzhiyun 		}
765*4882a593Smuzhiyun 	}
766*4882a593Smuzhiyun 
767*4882a593Smuzhiyun 	return ksz9031_center_flp_timing(phydev);
768*4882a593Smuzhiyun 
769*4882a593Smuzhiyun err_force_master:
770*4882a593Smuzhiyun 	phydev_err(phydev, "failed to force the phy to master mode\n");
771*4882a593Smuzhiyun 	return result;
772*4882a593Smuzhiyun }
773*4882a593Smuzhiyun 
774*4882a593Smuzhiyun #define KSZ9131_SKEW_5BIT_MAX	2400
775*4882a593Smuzhiyun #define KSZ9131_SKEW_4BIT_MAX	800
776*4882a593Smuzhiyun #define KSZ9131_OFFSET		700
777*4882a593Smuzhiyun #define KSZ9131_STEP		100
778*4882a593Smuzhiyun 
ksz9131_of_load_skew_values(struct phy_device * phydev,struct device_node * of_node,u16 reg,size_t field_sz,char * field[],u8 numfields)779*4882a593Smuzhiyun static int ksz9131_of_load_skew_values(struct phy_device *phydev,
780*4882a593Smuzhiyun 				       struct device_node *of_node,
781*4882a593Smuzhiyun 				       u16 reg, size_t field_sz,
782*4882a593Smuzhiyun 				       char *field[], u8 numfields)
783*4882a593Smuzhiyun {
784*4882a593Smuzhiyun 	int val[4] = {-(1 + KSZ9131_OFFSET), -(2 + KSZ9131_OFFSET),
785*4882a593Smuzhiyun 		      -(3 + KSZ9131_OFFSET), -(4 + KSZ9131_OFFSET)};
786*4882a593Smuzhiyun 	int skewval, skewmax = 0;
787*4882a593Smuzhiyun 	int matches = 0;
788*4882a593Smuzhiyun 	u16 maxval;
789*4882a593Smuzhiyun 	u16 newval;
790*4882a593Smuzhiyun 	u16 mask;
791*4882a593Smuzhiyun 	int i;
792*4882a593Smuzhiyun 
793*4882a593Smuzhiyun 	/* psec properties in dts should mean x pico seconds */
794*4882a593Smuzhiyun 	if (field_sz == 5)
795*4882a593Smuzhiyun 		skewmax = KSZ9131_SKEW_5BIT_MAX;
796*4882a593Smuzhiyun 	else
797*4882a593Smuzhiyun 		skewmax = KSZ9131_SKEW_4BIT_MAX;
798*4882a593Smuzhiyun 
799*4882a593Smuzhiyun 	for (i = 0; i < numfields; i++)
800*4882a593Smuzhiyun 		if (!of_property_read_s32(of_node, field[i], &skewval)) {
801*4882a593Smuzhiyun 			if (skewval < -KSZ9131_OFFSET)
802*4882a593Smuzhiyun 				skewval = -KSZ9131_OFFSET;
803*4882a593Smuzhiyun 			else if (skewval > skewmax)
804*4882a593Smuzhiyun 				skewval = skewmax;
805*4882a593Smuzhiyun 
806*4882a593Smuzhiyun 			val[i] = skewval + KSZ9131_OFFSET;
807*4882a593Smuzhiyun 			matches++;
808*4882a593Smuzhiyun 		}
809*4882a593Smuzhiyun 
810*4882a593Smuzhiyun 	if (!matches)
811*4882a593Smuzhiyun 		return 0;
812*4882a593Smuzhiyun 
813*4882a593Smuzhiyun 	if (matches < numfields)
814*4882a593Smuzhiyun 		newval = phy_read_mmd(phydev, 2, reg);
815*4882a593Smuzhiyun 	else
816*4882a593Smuzhiyun 		newval = 0;
817*4882a593Smuzhiyun 
818*4882a593Smuzhiyun 	maxval = (field_sz == 4) ? 0xf : 0x1f;
819*4882a593Smuzhiyun 	for (i = 0; i < numfields; i++)
820*4882a593Smuzhiyun 		if (val[i] != -(i + 1 + KSZ9131_OFFSET)) {
821*4882a593Smuzhiyun 			mask = 0xffff;
822*4882a593Smuzhiyun 			mask ^= maxval << (field_sz * i);
823*4882a593Smuzhiyun 			newval = (newval & mask) |
824*4882a593Smuzhiyun 				(((val[i] / KSZ9131_STEP) & maxval)
825*4882a593Smuzhiyun 					<< (field_sz * i));
826*4882a593Smuzhiyun 		}
827*4882a593Smuzhiyun 
828*4882a593Smuzhiyun 	return phy_write_mmd(phydev, 2, reg, newval);
829*4882a593Smuzhiyun }
830*4882a593Smuzhiyun 
831*4882a593Smuzhiyun #define KSZ9131RN_MMD_COMMON_CTRL_REG	2
832*4882a593Smuzhiyun #define KSZ9131RN_RXC_DLL_CTRL		76
833*4882a593Smuzhiyun #define KSZ9131RN_TXC_DLL_CTRL		77
834*4882a593Smuzhiyun #define KSZ9131RN_DLL_CTRL_BYPASS	BIT_MASK(12)
835*4882a593Smuzhiyun #define KSZ9131RN_DLL_ENABLE_DELAY	0
836*4882a593Smuzhiyun #define KSZ9131RN_DLL_DISABLE_DELAY	BIT(12)
837*4882a593Smuzhiyun 
ksz9131_config_rgmii_delay(struct phy_device * phydev)838*4882a593Smuzhiyun static int ksz9131_config_rgmii_delay(struct phy_device *phydev)
839*4882a593Smuzhiyun {
840*4882a593Smuzhiyun 	u16 rxcdll_val, txcdll_val;
841*4882a593Smuzhiyun 	int ret;
842*4882a593Smuzhiyun 
843*4882a593Smuzhiyun 	switch (phydev->interface) {
844*4882a593Smuzhiyun 	case PHY_INTERFACE_MODE_RGMII:
845*4882a593Smuzhiyun 		rxcdll_val = KSZ9131RN_DLL_DISABLE_DELAY;
846*4882a593Smuzhiyun 		txcdll_val = KSZ9131RN_DLL_DISABLE_DELAY;
847*4882a593Smuzhiyun 		break;
848*4882a593Smuzhiyun 	case PHY_INTERFACE_MODE_RGMII_ID:
849*4882a593Smuzhiyun 		rxcdll_val = KSZ9131RN_DLL_ENABLE_DELAY;
850*4882a593Smuzhiyun 		txcdll_val = KSZ9131RN_DLL_ENABLE_DELAY;
851*4882a593Smuzhiyun 		break;
852*4882a593Smuzhiyun 	case PHY_INTERFACE_MODE_RGMII_RXID:
853*4882a593Smuzhiyun 		rxcdll_val = KSZ9131RN_DLL_ENABLE_DELAY;
854*4882a593Smuzhiyun 		txcdll_val = KSZ9131RN_DLL_DISABLE_DELAY;
855*4882a593Smuzhiyun 		break;
856*4882a593Smuzhiyun 	case PHY_INTERFACE_MODE_RGMII_TXID:
857*4882a593Smuzhiyun 		rxcdll_val = KSZ9131RN_DLL_DISABLE_DELAY;
858*4882a593Smuzhiyun 		txcdll_val = KSZ9131RN_DLL_ENABLE_DELAY;
859*4882a593Smuzhiyun 		break;
860*4882a593Smuzhiyun 	default:
861*4882a593Smuzhiyun 		return 0;
862*4882a593Smuzhiyun 	}
863*4882a593Smuzhiyun 
864*4882a593Smuzhiyun 	ret = phy_modify_mmd(phydev, KSZ9131RN_MMD_COMMON_CTRL_REG,
865*4882a593Smuzhiyun 			     KSZ9131RN_RXC_DLL_CTRL, KSZ9131RN_DLL_CTRL_BYPASS,
866*4882a593Smuzhiyun 			     rxcdll_val);
867*4882a593Smuzhiyun 	if (ret < 0)
868*4882a593Smuzhiyun 		return ret;
869*4882a593Smuzhiyun 
870*4882a593Smuzhiyun 	return phy_modify_mmd(phydev, KSZ9131RN_MMD_COMMON_CTRL_REG,
871*4882a593Smuzhiyun 			      KSZ9131RN_TXC_DLL_CTRL, KSZ9131RN_DLL_CTRL_BYPASS,
872*4882a593Smuzhiyun 			      txcdll_val);
873*4882a593Smuzhiyun }
874*4882a593Smuzhiyun 
ksz9131_config_init(struct phy_device * phydev)875*4882a593Smuzhiyun static int ksz9131_config_init(struct phy_device *phydev)
876*4882a593Smuzhiyun {
877*4882a593Smuzhiyun 	const struct device *dev = &phydev->mdio.dev;
878*4882a593Smuzhiyun 	struct device_node *of_node = dev->of_node;
879*4882a593Smuzhiyun 	char *clk_skews[2] = {"rxc-skew-psec", "txc-skew-psec"};
880*4882a593Smuzhiyun 	char *rx_data_skews[4] = {
881*4882a593Smuzhiyun 		"rxd0-skew-psec", "rxd1-skew-psec",
882*4882a593Smuzhiyun 		"rxd2-skew-psec", "rxd3-skew-psec"
883*4882a593Smuzhiyun 	};
884*4882a593Smuzhiyun 	char *tx_data_skews[4] = {
885*4882a593Smuzhiyun 		"txd0-skew-psec", "txd1-skew-psec",
886*4882a593Smuzhiyun 		"txd2-skew-psec", "txd3-skew-psec"
887*4882a593Smuzhiyun 	};
888*4882a593Smuzhiyun 	char *control_skews[2] = {"txen-skew-psec", "rxdv-skew-psec"};
889*4882a593Smuzhiyun 	const struct device *dev_walker;
890*4882a593Smuzhiyun 	int ret;
891*4882a593Smuzhiyun 
892*4882a593Smuzhiyun 	dev_walker = &phydev->mdio.dev;
893*4882a593Smuzhiyun 	do {
894*4882a593Smuzhiyun 		of_node = dev_walker->of_node;
895*4882a593Smuzhiyun 		dev_walker = dev_walker->parent;
896*4882a593Smuzhiyun 	} while (!of_node && dev_walker);
897*4882a593Smuzhiyun 
898*4882a593Smuzhiyun 	if (!of_node)
899*4882a593Smuzhiyun 		return 0;
900*4882a593Smuzhiyun 
901*4882a593Smuzhiyun 	if (phy_interface_is_rgmii(phydev)) {
902*4882a593Smuzhiyun 		ret = ksz9131_config_rgmii_delay(phydev);
903*4882a593Smuzhiyun 		if (ret < 0)
904*4882a593Smuzhiyun 			return ret;
905*4882a593Smuzhiyun 	}
906*4882a593Smuzhiyun 
907*4882a593Smuzhiyun 	ret = ksz9131_of_load_skew_values(phydev, of_node,
908*4882a593Smuzhiyun 					  MII_KSZ9031RN_CLK_PAD_SKEW, 5,
909*4882a593Smuzhiyun 					  clk_skews, 2);
910*4882a593Smuzhiyun 	if (ret < 0)
911*4882a593Smuzhiyun 		return ret;
912*4882a593Smuzhiyun 
913*4882a593Smuzhiyun 	ret = ksz9131_of_load_skew_values(phydev, of_node,
914*4882a593Smuzhiyun 					  MII_KSZ9031RN_CONTROL_PAD_SKEW, 4,
915*4882a593Smuzhiyun 					  control_skews, 2);
916*4882a593Smuzhiyun 	if (ret < 0)
917*4882a593Smuzhiyun 		return ret;
918*4882a593Smuzhiyun 
919*4882a593Smuzhiyun 	ret = ksz9131_of_load_skew_values(phydev, of_node,
920*4882a593Smuzhiyun 					  MII_KSZ9031RN_RX_DATA_PAD_SKEW, 4,
921*4882a593Smuzhiyun 					  rx_data_skews, 4);
922*4882a593Smuzhiyun 	if (ret < 0)
923*4882a593Smuzhiyun 		return ret;
924*4882a593Smuzhiyun 
925*4882a593Smuzhiyun 	ret = ksz9131_of_load_skew_values(phydev, of_node,
926*4882a593Smuzhiyun 					  MII_KSZ9031RN_TX_DATA_PAD_SKEW, 4,
927*4882a593Smuzhiyun 					  tx_data_skews, 4);
928*4882a593Smuzhiyun 	if (ret < 0)
929*4882a593Smuzhiyun 		return ret;
930*4882a593Smuzhiyun 
931*4882a593Smuzhiyun 	return 0;
932*4882a593Smuzhiyun }
933*4882a593Smuzhiyun 
934*4882a593Smuzhiyun #define KSZ8873MLL_GLOBAL_CONTROL_4	0x06
935*4882a593Smuzhiyun #define KSZ8873MLL_GLOBAL_CONTROL_4_DUPLEX	BIT(6)
936*4882a593Smuzhiyun #define KSZ8873MLL_GLOBAL_CONTROL_4_SPEED	BIT(4)
ksz8873mll_read_status(struct phy_device * phydev)937*4882a593Smuzhiyun static int ksz8873mll_read_status(struct phy_device *phydev)
938*4882a593Smuzhiyun {
939*4882a593Smuzhiyun 	int regval;
940*4882a593Smuzhiyun 
941*4882a593Smuzhiyun 	/* dummy read */
942*4882a593Smuzhiyun 	regval = phy_read(phydev, KSZ8873MLL_GLOBAL_CONTROL_4);
943*4882a593Smuzhiyun 
944*4882a593Smuzhiyun 	regval = phy_read(phydev, KSZ8873MLL_GLOBAL_CONTROL_4);
945*4882a593Smuzhiyun 
946*4882a593Smuzhiyun 	if (regval & KSZ8873MLL_GLOBAL_CONTROL_4_DUPLEX)
947*4882a593Smuzhiyun 		phydev->duplex = DUPLEX_HALF;
948*4882a593Smuzhiyun 	else
949*4882a593Smuzhiyun 		phydev->duplex = DUPLEX_FULL;
950*4882a593Smuzhiyun 
951*4882a593Smuzhiyun 	if (regval & KSZ8873MLL_GLOBAL_CONTROL_4_SPEED)
952*4882a593Smuzhiyun 		phydev->speed = SPEED_10;
953*4882a593Smuzhiyun 	else
954*4882a593Smuzhiyun 		phydev->speed = SPEED_100;
955*4882a593Smuzhiyun 
956*4882a593Smuzhiyun 	phydev->link = 1;
957*4882a593Smuzhiyun 	phydev->pause = phydev->asym_pause = 0;
958*4882a593Smuzhiyun 
959*4882a593Smuzhiyun 	return 0;
960*4882a593Smuzhiyun }
961*4882a593Smuzhiyun 
ksz9031_get_features(struct phy_device * phydev)962*4882a593Smuzhiyun static int ksz9031_get_features(struct phy_device *phydev)
963*4882a593Smuzhiyun {
964*4882a593Smuzhiyun 	int ret;
965*4882a593Smuzhiyun 
966*4882a593Smuzhiyun 	ret = genphy_read_abilities(phydev);
967*4882a593Smuzhiyun 	if (ret < 0)
968*4882a593Smuzhiyun 		return ret;
969*4882a593Smuzhiyun 
970*4882a593Smuzhiyun 	/* Silicon Errata Sheet (DS80000691D or DS80000692D):
971*4882a593Smuzhiyun 	 * Whenever the device's Asymmetric Pause capability is set to 1,
972*4882a593Smuzhiyun 	 * link-up may fail after a link-up to link-down transition.
973*4882a593Smuzhiyun 	 *
974*4882a593Smuzhiyun 	 * The Errata Sheet is for ksz9031, but ksz9021 has the same issue
975*4882a593Smuzhiyun 	 *
976*4882a593Smuzhiyun 	 * Workaround:
977*4882a593Smuzhiyun 	 * Do not enable the Asymmetric Pause capability bit.
978*4882a593Smuzhiyun 	 */
979*4882a593Smuzhiyun 	linkmode_clear_bit(ETHTOOL_LINK_MODE_Asym_Pause_BIT, phydev->supported);
980*4882a593Smuzhiyun 
981*4882a593Smuzhiyun 	/* We force setting the Pause capability as the core will force the
982*4882a593Smuzhiyun 	 * Asymmetric Pause capability to 1 otherwise.
983*4882a593Smuzhiyun 	 */
984*4882a593Smuzhiyun 	linkmode_set_bit(ETHTOOL_LINK_MODE_Pause_BIT, phydev->supported);
985*4882a593Smuzhiyun 
986*4882a593Smuzhiyun 	return 0;
987*4882a593Smuzhiyun }
988*4882a593Smuzhiyun 
ksz9031_read_status(struct phy_device * phydev)989*4882a593Smuzhiyun static int ksz9031_read_status(struct phy_device *phydev)
990*4882a593Smuzhiyun {
991*4882a593Smuzhiyun 	int err;
992*4882a593Smuzhiyun 	int regval;
993*4882a593Smuzhiyun 
994*4882a593Smuzhiyun 	err = genphy_read_status(phydev);
995*4882a593Smuzhiyun 	if (err)
996*4882a593Smuzhiyun 		return err;
997*4882a593Smuzhiyun 
998*4882a593Smuzhiyun 	/* Make sure the PHY is not broken. Read idle error count,
999*4882a593Smuzhiyun 	 * and reset the PHY if it is maxed out.
1000*4882a593Smuzhiyun 	 */
1001*4882a593Smuzhiyun 	regval = phy_read(phydev, MII_STAT1000);
1002*4882a593Smuzhiyun 	if ((regval & 0xFF) == 0xFF) {
1003*4882a593Smuzhiyun 		phy_init_hw(phydev);
1004*4882a593Smuzhiyun 		phydev->link = 0;
1005*4882a593Smuzhiyun 		if (phydev->drv->config_intr && phy_interrupt_is_valid(phydev))
1006*4882a593Smuzhiyun 			phydev->drv->config_intr(phydev);
1007*4882a593Smuzhiyun 		return genphy_config_aneg(phydev);
1008*4882a593Smuzhiyun 	}
1009*4882a593Smuzhiyun 
1010*4882a593Smuzhiyun 	return 0;
1011*4882a593Smuzhiyun }
1012*4882a593Smuzhiyun 
ksz8873mll_config_aneg(struct phy_device * phydev)1013*4882a593Smuzhiyun static int ksz8873mll_config_aneg(struct phy_device *phydev)
1014*4882a593Smuzhiyun {
1015*4882a593Smuzhiyun 	return 0;
1016*4882a593Smuzhiyun }
1017*4882a593Smuzhiyun 
kszphy_get_sset_count(struct phy_device * phydev)1018*4882a593Smuzhiyun static int kszphy_get_sset_count(struct phy_device *phydev)
1019*4882a593Smuzhiyun {
1020*4882a593Smuzhiyun 	return ARRAY_SIZE(kszphy_hw_stats);
1021*4882a593Smuzhiyun }
1022*4882a593Smuzhiyun 
kszphy_get_strings(struct phy_device * phydev,u8 * data)1023*4882a593Smuzhiyun static void kszphy_get_strings(struct phy_device *phydev, u8 *data)
1024*4882a593Smuzhiyun {
1025*4882a593Smuzhiyun 	int i;
1026*4882a593Smuzhiyun 
1027*4882a593Smuzhiyun 	for (i = 0; i < ARRAY_SIZE(kszphy_hw_stats); i++) {
1028*4882a593Smuzhiyun 		strlcpy(data + i * ETH_GSTRING_LEN,
1029*4882a593Smuzhiyun 			kszphy_hw_stats[i].string, ETH_GSTRING_LEN);
1030*4882a593Smuzhiyun 	}
1031*4882a593Smuzhiyun }
1032*4882a593Smuzhiyun 
kszphy_get_stat(struct phy_device * phydev,int i)1033*4882a593Smuzhiyun static u64 kszphy_get_stat(struct phy_device *phydev, int i)
1034*4882a593Smuzhiyun {
1035*4882a593Smuzhiyun 	struct kszphy_hw_stat stat = kszphy_hw_stats[i];
1036*4882a593Smuzhiyun 	struct kszphy_priv *priv = phydev->priv;
1037*4882a593Smuzhiyun 	int val;
1038*4882a593Smuzhiyun 	u64 ret;
1039*4882a593Smuzhiyun 
1040*4882a593Smuzhiyun 	val = phy_read(phydev, stat.reg);
1041*4882a593Smuzhiyun 	if (val < 0) {
1042*4882a593Smuzhiyun 		ret = U64_MAX;
1043*4882a593Smuzhiyun 	} else {
1044*4882a593Smuzhiyun 		val = val & ((1 << stat.bits) - 1);
1045*4882a593Smuzhiyun 		priv->stats[i] += val;
1046*4882a593Smuzhiyun 		ret = priv->stats[i];
1047*4882a593Smuzhiyun 	}
1048*4882a593Smuzhiyun 
1049*4882a593Smuzhiyun 	return ret;
1050*4882a593Smuzhiyun }
1051*4882a593Smuzhiyun 
kszphy_get_stats(struct phy_device * phydev,struct ethtool_stats * stats,u64 * data)1052*4882a593Smuzhiyun static void kszphy_get_stats(struct phy_device *phydev,
1053*4882a593Smuzhiyun 			     struct ethtool_stats *stats, u64 *data)
1054*4882a593Smuzhiyun {
1055*4882a593Smuzhiyun 	int i;
1056*4882a593Smuzhiyun 
1057*4882a593Smuzhiyun 	for (i = 0; i < ARRAY_SIZE(kszphy_hw_stats); i++)
1058*4882a593Smuzhiyun 		data[i] = kszphy_get_stat(phydev, i);
1059*4882a593Smuzhiyun }
1060*4882a593Smuzhiyun 
kszphy_suspend(struct phy_device * phydev)1061*4882a593Smuzhiyun static int kszphy_suspend(struct phy_device *phydev)
1062*4882a593Smuzhiyun {
1063*4882a593Smuzhiyun 	/* Disable PHY Interrupts */
1064*4882a593Smuzhiyun 	if (phy_interrupt_is_valid(phydev)) {
1065*4882a593Smuzhiyun 		phydev->interrupts = PHY_INTERRUPT_DISABLED;
1066*4882a593Smuzhiyun 		if (phydev->drv->config_intr)
1067*4882a593Smuzhiyun 			phydev->drv->config_intr(phydev);
1068*4882a593Smuzhiyun 	}
1069*4882a593Smuzhiyun 
1070*4882a593Smuzhiyun 	return genphy_suspend(phydev);
1071*4882a593Smuzhiyun }
1072*4882a593Smuzhiyun 
kszphy_resume(struct phy_device * phydev)1073*4882a593Smuzhiyun static int kszphy_resume(struct phy_device *phydev)
1074*4882a593Smuzhiyun {
1075*4882a593Smuzhiyun 	int ret;
1076*4882a593Smuzhiyun 
1077*4882a593Smuzhiyun 	genphy_resume(phydev);
1078*4882a593Smuzhiyun 
1079*4882a593Smuzhiyun 	/* After switching from power-down to normal mode, an internal global
1080*4882a593Smuzhiyun 	 * reset is automatically generated. Wait a minimum of 1 ms before
1081*4882a593Smuzhiyun 	 * read/write access to the PHY registers.
1082*4882a593Smuzhiyun 	 */
1083*4882a593Smuzhiyun 	usleep_range(1000, 2000);
1084*4882a593Smuzhiyun 
1085*4882a593Smuzhiyun 	ret = kszphy_config_reset(phydev);
1086*4882a593Smuzhiyun 	if (ret)
1087*4882a593Smuzhiyun 		return ret;
1088*4882a593Smuzhiyun 
1089*4882a593Smuzhiyun 	/* Enable PHY Interrupts */
1090*4882a593Smuzhiyun 	if (phy_interrupt_is_valid(phydev)) {
1091*4882a593Smuzhiyun 		phydev->interrupts = PHY_INTERRUPT_ENABLED;
1092*4882a593Smuzhiyun 		if (phydev->drv->config_intr)
1093*4882a593Smuzhiyun 			phydev->drv->config_intr(phydev);
1094*4882a593Smuzhiyun 	}
1095*4882a593Smuzhiyun 
1096*4882a593Smuzhiyun 	return 0;
1097*4882a593Smuzhiyun }
1098*4882a593Smuzhiyun 
kszphy_probe(struct phy_device * phydev)1099*4882a593Smuzhiyun static int kszphy_probe(struct phy_device *phydev)
1100*4882a593Smuzhiyun {
1101*4882a593Smuzhiyun 	const struct kszphy_type *type = phydev->drv->driver_data;
1102*4882a593Smuzhiyun 	const struct device_node *np = phydev->mdio.dev.of_node;
1103*4882a593Smuzhiyun 	struct kszphy_priv *priv;
1104*4882a593Smuzhiyun 	struct clk *clk;
1105*4882a593Smuzhiyun 	int ret;
1106*4882a593Smuzhiyun 
1107*4882a593Smuzhiyun 	priv = devm_kzalloc(&phydev->mdio.dev, sizeof(*priv), GFP_KERNEL);
1108*4882a593Smuzhiyun 	if (!priv)
1109*4882a593Smuzhiyun 		return -ENOMEM;
1110*4882a593Smuzhiyun 
1111*4882a593Smuzhiyun 	phydev->priv = priv;
1112*4882a593Smuzhiyun 
1113*4882a593Smuzhiyun 	priv->type = type;
1114*4882a593Smuzhiyun 
1115*4882a593Smuzhiyun 	if (type && type->led_mode_reg) {
1116*4882a593Smuzhiyun 		ret = of_property_read_u32(np, "micrel,led-mode",
1117*4882a593Smuzhiyun 				&priv->led_mode);
1118*4882a593Smuzhiyun 		if (ret)
1119*4882a593Smuzhiyun 			priv->led_mode = -1;
1120*4882a593Smuzhiyun 
1121*4882a593Smuzhiyun 		if (priv->led_mode > 3) {
1122*4882a593Smuzhiyun 			phydev_err(phydev, "invalid led mode: 0x%02x\n",
1123*4882a593Smuzhiyun 				   priv->led_mode);
1124*4882a593Smuzhiyun 			priv->led_mode = -1;
1125*4882a593Smuzhiyun 		}
1126*4882a593Smuzhiyun 	} else {
1127*4882a593Smuzhiyun 		priv->led_mode = -1;
1128*4882a593Smuzhiyun 	}
1129*4882a593Smuzhiyun 
1130*4882a593Smuzhiyun 	clk = devm_clk_get(&phydev->mdio.dev, "rmii-ref");
1131*4882a593Smuzhiyun 	/* NOTE: clk may be NULL if building without CONFIG_HAVE_CLK */
1132*4882a593Smuzhiyun 	if (!IS_ERR_OR_NULL(clk)) {
1133*4882a593Smuzhiyun 		unsigned long rate = clk_get_rate(clk);
1134*4882a593Smuzhiyun 		bool rmii_ref_clk_sel_25_mhz;
1135*4882a593Smuzhiyun 
1136*4882a593Smuzhiyun 		if (type)
1137*4882a593Smuzhiyun 			priv->rmii_ref_clk_sel = type->has_rmii_ref_clk_sel;
1138*4882a593Smuzhiyun 		rmii_ref_clk_sel_25_mhz = of_property_read_bool(np,
1139*4882a593Smuzhiyun 				"micrel,rmii-reference-clock-select-25-mhz");
1140*4882a593Smuzhiyun 
1141*4882a593Smuzhiyun 		if (rate > 24500000 && rate < 25500000) {
1142*4882a593Smuzhiyun 			priv->rmii_ref_clk_sel_val = rmii_ref_clk_sel_25_mhz;
1143*4882a593Smuzhiyun 		} else if (rate > 49500000 && rate < 50500000) {
1144*4882a593Smuzhiyun 			priv->rmii_ref_clk_sel_val = !rmii_ref_clk_sel_25_mhz;
1145*4882a593Smuzhiyun 		} else {
1146*4882a593Smuzhiyun 			phydev_err(phydev, "Clock rate out of range: %ld\n",
1147*4882a593Smuzhiyun 				   rate);
1148*4882a593Smuzhiyun 			return -EINVAL;
1149*4882a593Smuzhiyun 		}
1150*4882a593Smuzhiyun 	}
1151*4882a593Smuzhiyun 
1152*4882a593Smuzhiyun 	if (ksz8041_fiber_mode(phydev))
1153*4882a593Smuzhiyun 		phydev->port = PORT_FIBRE;
1154*4882a593Smuzhiyun 
1155*4882a593Smuzhiyun 	/* Support legacy board-file configuration */
1156*4882a593Smuzhiyun 	if (phydev->dev_flags & MICREL_PHY_50MHZ_CLK) {
1157*4882a593Smuzhiyun 		priv->rmii_ref_clk_sel = true;
1158*4882a593Smuzhiyun 		priv->rmii_ref_clk_sel_val = true;
1159*4882a593Smuzhiyun 	}
1160*4882a593Smuzhiyun 
1161*4882a593Smuzhiyun 	return 0;
1162*4882a593Smuzhiyun }
1163*4882a593Smuzhiyun 
1164*4882a593Smuzhiyun static struct phy_driver ksphy_driver[] = {
1165*4882a593Smuzhiyun {
1166*4882a593Smuzhiyun 	.phy_id		= PHY_ID_KS8737,
1167*4882a593Smuzhiyun 	.phy_id_mask	= MICREL_PHY_ID_MASK,
1168*4882a593Smuzhiyun 	.name		= "Micrel KS8737",
1169*4882a593Smuzhiyun 	/* PHY_BASIC_FEATURES */
1170*4882a593Smuzhiyun 	.driver_data	= &ks8737_type,
1171*4882a593Smuzhiyun 	.config_init	= kszphy_config_init,
1172*4882a593Smuzhiyun 	.ack_interrupt	= kszphy_ack_interrupt,
1173*4882a593Smuzhiyun 	.config_intr	= kszphy_config_intr,
1174*4882a593Smuzhiyun 	.suspend	= genphy_suspend,
1175*4882a593Smuzhiyun 	.resume		= genphy_resume,
1176*4882a593Smuzhiyun }, {
1177*4882a593Smuzhiyun 	.phy_id		= PHY_ID_KSZ8021,
1178*4882a593Smuzhiyun 	.phy_id_mask	= 0x00ffffff,
1179*4882a593Smuzhiyun 	.name		= "Micrel KSZ8021 or KSZ8031",
1180*4882a593Smuzhiyun 	/* PHY_BASIC_FEATURES */
1181*4882a593Smuzhiyun 	.driver_data	= &ksz8021_type,
1182*4882a593Smuzhiyun 	.probe		= kszphy_probe,
1183*4882a593Smuzhiyun 	.config_init	= kszphy_config_init,
1184*4882a593Smuzhiyun 	.ack_interrupt	= kszphy_ack_interrupt,
1185*4882a593Smuzhiyun 	.config_intr	= kszphy_config_intr,
1186*4882a593Smuzhiyun 	.get_sset_count = kszphy_get_sset_count,
1187*4882a593Smuzhiyun 	.get_strings	= kszphy_get_strings,
1188*4882a593Smuzhiyun 	.get_stats	= kszphy_get_stats,
1189*4882a593Smuzhiyun 	.suspend	= genphy_suspend,
1190*4882a593Smuzhiyun 	.resume		= genphy_resume,
1191*4882a593Smuzhiyun }, {
1192*4882a593Smuzhiyun 	.phy_id		= PHY_ID_KSZ8031,
1193*4882a593Smuzhiyun 	.phy_id_mask	= 0x00ffffff,
1194*4882a593Smuzhiyun 	.name		= "Micrel KSZ8031",
1195*4882a593Smuzhiyun 	/* PHY_BASIC_FEATURES */
1196*4882a593Smuzhiyun 	.driver_data	= &ksz8021_type,
1197*4882a593Smuzhiyun 	.probe		= kszphy_probe,
1198*4882a593Smuzhiyun 	.config_init	= kszphy_config_init,
1199*4882a593Smuzhiyun 	.ack_interrupt	= kszphy_ack_interrupt,
1200*4882a593Smuzhiyun 	.config_intr	= kszphy_config_intr,
1201*4882a593Smuzhiyun 	.get_sset_count = kszphy_get_sset_count,
1202*4882a593Smuzhiyun 	.get_strings	= kszphy_get_strings,
1203*4882a593Smuzhiyun 	.get_stats	= kszphy_get_stats,
1204*4882a593Smuzhiyun 	.suspend	= genphy_suspend,
1205*4882a593Smuzhiyun 	.resume		= genphy_resume,
1206*4882a593Smuzhiyun }, {
1207*4882a593Smuzhiyun 	.phy_id		= PHY_ID_KSZ8041,
1208*4882a593Smuzhiyun 	.phy_id_mask	= MICREL_PHY_ID_MASK,
1209*4882a593Smuzhiyun 	.name		= "Micrel KSZ8041",
1210*4882a593Smuzhiyun 	/* PHY_BASIC_FEATURES */
1211*4882a593Smuzhiyun 	.driver_data	= &ksz8041_type,
1212*4882a593Smuzhiyun 	.probe		= kszphy_probe,
1213*4882a593Smuzhiyun 	.config_init	= ksz8041_config_init,
1214*4882a593Smuzhiyun 	.config_aneg	= ksz8041_config_aneg,
1215*4882a593Smuzhiyun 	.ack_interrupt	= kszphy_ack_interrupt,
1216*4882a593Smuzhiyun 	.config_intr	= kszphy_config_intr,
1217*4882a593Smuzhiyun 	.get_sset_count = kszphy_get_sset_count,
1218*4882a593Smuzhiyun 	.get_strings	= kszphy_get_strings,
1219*4882a593Smuzhiyun 	.get_stats	= kszphy_get_stats,
1220*4882a593Smuzhiyun 	/* No suspend/resume callbacks because of errata DS80000700A,
1221*4882a593Smuzhiyun 	 * receiver error following software power down.
1222*4882a593Smuzhiyun 	 */
1223*4882a593Smuzhiyun }, {
1224*4882a593Smuzhiyun 	.phy_id		= PHY_ID_KSZ8041RNLI,
1225*4882a593Smuzhiyun 	.phy_id_mask	= MICREL_PHY_ID_MASK,
1226*4882a593Smuzhiyun 	.name		= "Micrel KSZ8041RNLI",
1227*4882a593Smuzhiyun 	/* PHY_BASIC_FEATURES */
1228*4882a593Smuzhiyun 	.driver_data	= &ksz8041_type,
1229*4882a593Smuzhiyun 	.probe		= kszphy_probe,
1230*4882a593Smuzhiyun 	.config_init	= kszphy_config_init,
1231*4882a593Smuzhiyun 	.ack_interrupt	= kszphy_ack_interrupt,
1232*4882a593Smuzhiyun 	.config_intr	= kszphy_config_intr,
1233*4882a593Smuzhiyun 	.get_sset_count = kszphy_get_sset_count,
1234*4882a593Smuzhiyun 	.get_strings	= kszphy_get_strings,
1235*4882a593Smuzhiyun 	.get_stats	= kszphy_get_stats,
1236*4882a593Smuzhiyun 	.suspend	= genphy_suspend,
1237*4882a593Smuzhiyun 	.resume		= genphy_resume,
1238*4882a593Smuzhiyun }, {
1239*4882a593Smuzhiyun 	.name		= "Micrel KSZ8051",
1240*4882a593Smuzhiyun 	/* PHY_BASIC_FEATURES */
1241*4882a593Smuzhiyun 	.driver_data	= &ksz8051_type,
1242*4882a593Smuzhiyun 	.probe		= kszphy_probe,
1243*4882a593Smuzhiyun 	.config_init	= kszphy_config_init,
1244*4882a593Smuzhiyun 	.ack_interrupt	= kszphy_ack_interrupt,
1245*4882a593Smuzhiyun 	.config_intr	= kszphy_config_intr,
1246*4882a593Smuzhiyun 	.get_sset_count = kszphy_get_sset_count,
1247*4882a593Smuzhiyun 	.get_strings	= kszphy_get_strings,
1248*4882a593Smuzhiyun 	.get_stats	= kszphy_get_stats,
1249*4882a593Smuzhiyun 	.match_phy_device = ksz8051_match_phy_device,
1250*4882a593Smuzhiyun 	.suspend	= genphy_suspend,
1251*4882a593Smuzhiyun 	.resume		= genphy_resume,
1252*4882a593Smuzhiyun }, {
1253*4882a593Smuzhiyun 	.phy_id		= PHY_ID_KSZ8001,
1254*4882a593Smuzhiyun 	.name		= "Micrel KSZ8001 or KS8721",
1255*4882a593Smuzhiyun 	.phy_id_mask	= 0x00fffffc,
1256*4882a593Smuzhiyun 	/* PHY_BASIC_FEATURES */
1257*4882a593Smuzhiyun 	.driver_data	= &ksz8041_type,
1258*4882a593Smuzhiyun 	.probe		= kszphy_probe,
1259*4882a593Smuzhiyun 	.config_init	= kszphy_config_init,
1260*4882a593Smuzhiyun 	.ack_interrupt	= kszphy_ack_interrupt,
1261*4882a593Smuzhiyun 	.config_intr	= kszphy_config_intr,
1262*4882a593Smuzhiyun 	.get_sset_count = kszphy_get_sset_count,
1263*4882a593Smuzhiyun 	.get_strings	= kszphy_get_strings,
1264*4882a593Smuzhiyun 	.get_stats	= kszphy_get_stats,
1265*4882a593Smuzhiyun 	.suspend	= genphy_suspend,
1266*4882a593Smuzhiyun 	.resume		= genphy_resume,
1267*4882a593Smuzhiyun }, {
1268*4882a593Smuzhiyun 	.phy_id		= PHY_ID_KSZ8081,
1269*4882a593Smuzhiyun 	.name		= "Micrel KSZ8081 or KSZ8091",
1270*4882a593Smuzhiyun 	.phy_id_mask	= MICREL_PHY_ID_MASK,
1271*4882a593Smuzhiyun 	/* PHY_BASIC_FEATURES */
1272*4882a593Smuzhiyun 	.driver_data	= &ksz8081_type,
1273*4882a593Smuzhiyun 	.probe		= kszphy_probe,
1274*4882a593Smuzhiyun 	.config_init	= ksz8081_config_init,
1275*4882a593Smuzhiyun 	.ack_interrupt	= kszphy_ack_interrupt,
1276*4882a593Smuzhiyun 	.soft_reset	= genphy_soft_reset,
1277*4882a593Smuzhiyun 	.config_intr	= kszphy_config_intr,
1278*4882a593Smuzhiyun 	.get_sset_count = kszphy_get_sset_count,
1279*4882a593Smuzhiyun 	.get_strings	= kszphy_get_strings,
1280*4882a593Smuzhiyun 	.get_stats	= kszphy_get_stats,
1281*4882a593Smuzhiyun 	.suspend	= kszphy_suspend,
1282*4882a593Smuzhiyun 	.resume		= kszphy_resume,
1283*4882a593Smuzhiyun }, {
1284*4882a593Smuzhiyun 	.phy_id		= PHY_ID_KSZ8061,
1285*4882a593Smuzhiyun 	.name		= "Micrel KSZ8061",
1286*4882a593Smuzhiyun 	.phy_id_mask	= MICREL_PHY_ID_MASK,
1287*4882a593Smuzhiyun 	/* PHY_BASIC_FEATURES */
1288*4882a593Smuzhiyun 	.config_init	= ksz8061_config_init,
1289*4882a593Smuzhiyun 	.ack_interrupt	= kszphy_ack_interrupt,
1290*4882a593Smuzhiyun 	.config_intr	= kszphy_config_intr,
1291*4882a593Smuzhiyun 	.suspend	= genphy_suspend,
1292*4882a593Smuzhiyun 	.resume		= genphy_resume,
1293*4882a593Smuzhiyun }, {
1294*4882a593Smuzhiyun 	.phy_id		= PHY_ID_KSZ9021,
1295*4882a593Smuzhiyun 	.phy_id_mask	= 0x000ffffe,
1296*4882a593Smuzhiyun 	.name		= "Micrel KSZ9021 Gigabit PHY",
1297*4882a593Smuzhiyun 	/* PHY_GBIT_FEATURES */
1298*4882a593Smuzhiyun 	.driver_data	= &ksz9021_type,
1299*4882a593Smuzhiyun 	.probe		= kszphy_probe,
1300*4882a593Smuzhiyun 	.get_features	= ksz9031_get_features,
1301*4882a593Smuzhiyun 	.config_init	= ksz9021_config_init,
1302*4882a593Smuzhiyun 	.ack_interrupt	= kszphy_ack_interrupt,
1303*4882a593Smuzhiyun 	.config_intr	= kszphy_config_intr,
1304*4882a593Smuzhiyun 	.get_sset_count = kszphy_get_sset_count,
1305*4882a593Smuzhiyun 	.get_strings	= kszphy_get_strings,
1306*4882a593Smuzhiyun 	.get_stats	= kszphy_get_stats,
1307*4882a593Smuzhiyun 	.suspend	= genphy_suspend,
1308*4882a593Smuzhiyun 	.resume		= genphy_resume,
1309*4882a593Smuzhiyun 	.read_mmd	= genphy_read_mmd_unsupported,
1310*4882a593Smuzhiyun 	.write_mmd	= genphy_write_mmd_unsupported,
1311*4882a593Smuzhiyun }, {
1312*4882a593Smuzhiyun 	.phy_id		= PHY_ID_KSZ9031,
1313*4882a593Smuzhiyun 	.phy_id_mask	= MICREL_PHY_ID_MASK,
1314*4882a593Smuzhiyun 	.name		= "Micrel KSZ9031 Gigabit PHY",
1315*4882a593Smuzhiyun 	.driver_data	= &ksz9021_type,
1316*4882a593Smuzhiyun 	.probe		= kszphy_probe,
1317*4882a593Smuzhiyun 	.get_features	= ksz9031_get_features,
1318*4882a593Smuzhiyun 	.config_init	= ksz9031_config_init,
1319*4882a593Smuzhiyun 	.soft_reset	= genphy_soft_reset,
1320*4882a593Smuzhiyun 	.read_status	= ksz9031_read_status,
1321*4882a593Smuzhiyun 	.ack_interrupt	= kszphy_ack_interrupt,
1322*4882a593Smuzhiyun 	.config_intr	= kszphy_config_intr,
1323*4882a593Smuzhiyun 	.get_sset_count = kszphy_get_sset_count,
1324*4882a593Smuzhiyun 	.get_strings	= kszphy_get_strings,
1325*4882a593Smuzhiyun 	.get_stats	= kszphy_get_stats,
1326*4882a593Smuzhiyun 	.suspend	= genphy_suspend,
1327*4882a593Smuzhiyun 	.resume		= kszphy_resume,
1328*4882a593Smuzhiyun }, {
1329*4882a593Smuzhiyun 	.phy_id		= PHY_ID_LAN8814,
1330*4882a593Smuzhiyun 	.phy_id_mask	= MICREL_PHY_ID_MASK,
1331*4882a593Smuzhiyun 	.name		= "Microchip INDY Gigabit Quad PHY",
1332*4882a593Smuzhiyun 	.driver_data	= &ksz9021_type,
1333*4882a593Smuzhiyun 	.probe		= kszphy_probe,
1334*4882a593Smuzhiyun 	.soft_reset	= genphy_soft_reset,
1335*4882a593Smuzhiyun 	.read_status	= ksz9031_read_status,
1336*4882a593Smuzhiyun 	.get_sset_count	= kszphy_get_sset_count,
1337*4882a593Smuzhiyun 	.get_strings	= kszphy_get_strings,
1338*4882a593Smuzhiyun 	.get_stats	= kszphy_get_stats,
1339*4882a593Smuzhiyun 	.suspend	= genphy_suspend,
1340*4882a593Smuzhiyun 	.resume		= kszphy_resume,
1341*4882a593Smuzhiyun }, {
1342*4882a593Smuzhiyun 	.phy_id		= PHY_ID_KSZ9131,
1343*4882a593Smuzhiyun 	.phy_id_mask	= MICREL_PHY_ID_MASK,
1344*4882a593Smuzhiyun 	.name		= "Microchip KSZ9131 Gigabit PHY",
1345*4882a593Smuzhiyun 	/* PHY_GBIT_FEATURES */
1346*4882a593Smuzhiyun 	.driver_data	= &ksz9021_type,
1347*4882a593Smuzhiyun 	.probe		= kszphy_probe,
1348*4882a593Smuzhiyun 	.config_init	= ksz9131_config_init,
1349*4882a593Smuzhiyun 	.read_status	= genphy_read_status,
1350*4882a593Smuzhiyun 	.ack_interrupt	= kszphy_ack_interrupt,
1351*4882a593Smuzhiyun 	.config_intr	= kszphy_config_intr,
1352*4882a593Smuzhiyun 	.get_sset_count = kszphy_get_sset_count,
1353*4882a593Smuzhiyun 	.get_strings	= kszphy_get_strings,
1354*4882a593Smuzhiyun 	.get_stats	= kszphy_get_stats,
1355*4882a593Smuzhiyun 	.suspend	= genphy_suspend,
1356*4882a593Smuzhiyun 	.resume		= kszphy_resume,
1357*4882a593Smuzhiyun }, {
1358*4882a593Smuzhiyun 	.phy_id		= PHY_ID_KSZ8873MLL,
1359*4882a593Smuzhiyun 	.phy_id_mask	= MICREL_PHY_ID_MASK,
1360*4882a593Smuzhiyun 	.name		= "Micrel KSZ8873MLL Switch",
1361*4882a593Smuzhiyun 	/* PHY_BASIC_FEATURES */
1362*4882a593Smuzhiyun 	.config_init	= kszphy_config_init,
1363*4882a593Smuzhiyun 	.config_aneg	= ksz8873mll_config_aneg,
1364*4882a593Smuzhiyun 	.read_status	= ksz8873mll_read_status,
1365*4882a593Smuzhiyun 	.suspend	= genphy_suspend,
1366*4882a593Smuzhiyun 	.resume		= genphy_resume,
1367*4882a593Smuzhiyun }, {
1368*4882a593Smuzhiyun 	.phy_id		= PHY_ID_KSZ886X,
1369*4882a593Smuzhiyun 	.phy_id_mask	= MICREL_PHY_ID_MASK,
1370*4882a593Smuzhiyun 	.name		= "Micrel KSZ886X Switch",
1371*4882a593Smuzhiyun 	/* PHY_BASIC_FEATURES */
1372*4882a593Smuzhiyun 	.config_init	= kszphy_config_init,
1373*4882a593Smuzhiyun 	.suspend	= genphy_suspend,
1374*4882a593Smuzhiyun 	.resume		= genphy_resume,
1375*4882a593Smuzhiyun }, {
1376*4882a593Smuzhiyun 	.name		= "Micrel KSZ87XX Switch",
1377*4882a593Smuzhiyun 	/* PHY_BASIC_FEATURES */
1378*4882a593Smuzhiyun 	.config_init	= kszphy_config_init,
1379*4882a593Smuzhiyun 	.match_phy_device = ksz8795_match_phy_device,
1380*4882a593Smuzhiyun 	.suspend	= genphy_suspend,
1381*4882a593Smuzhiyun 	.resume		= genphy_resume,
1382*4882a593Smuzhiyun }, {
1383*4882a593Smuzhiyun 	.phy_id		= PHY_ID_KSZ9477,
1384*4882a593Smuzhiyun 	.phy_id_mask	= MICREL_PHY_ID_MASK,
1385*4882a593Smuzhiyun 	.name		= "Microchip KSZ9477",
1386*4882a593Smuzhiyun 	/* PHY_GBIT_FEATURES */
1387*4882a593Smuzhiyun 	.config_init	= kszphy_config_init,
1388*4882a593Smuzhiyun 	.suspend	= genphy_suspend,
1389*4882a593Smuzhiyun 	.resume		= genphy_resume,
1390*4882a593Smuzhiyun } };
1391*4882a593Smuzhiyun 
1392*4882a593Smuzhiyun module_phy_driver(ksphy_driver);
1393*4882a593Smuzhiyun 
1394*4882a593Smuzhiyun MODULE_DESCRIPTION("Micrel PHY driver");
1395*4882a593Smuzhiyun MODULE_AUTHOR("David J. Choi");
1396*4882a593Smuzhiyun MODULE_LICENSE("GPL");
1397*4882a593Smuzhiyun 
1398*4882a593Smuzhiyun static struct mdio_device_id __maybe_unused micrel_tbl[] = {
1399*4882a593Smuzhiyun 	{ PHY_ID_KSZ9021, 0x000ffffe },
1400*4882a593Smuzhiyun 	{ PHY_ID_KSZ9031, MICREL_PHY_ID_MASK },
1401*4882a593Smuzhiyun 	{ PHY_ID_KSZ9131, MICREL_PHY_ID_MASK },
1402*4882a593Smuzhiyun 	{ PHY_ID_KSZ8001, 0x00fffffc },
1403*4882a593Smuzhiyun 	{ PHY_ID_KS8737, MICREL_PHY_ID_MASK },
1404*4882a593Smuzhiyun 	{ PHY_ID_KSZ8021, 0x00ffffff },
1405*4882a593Smuzhiyun 	{ PHY_ID_KSZ8031, 0x00ffffff },
1406*4882a593Smuzhiyun 	{ PHY_ID_KSZ8041, MICREL_PHY_ID_MASK },
1407*4882a593Smuzhiyun 	{ PHY_ID_KSZ8051, MICREL_PHY_ID_MASK },
1408*4882a593Smuzhiyun 	{ PHY_ID_KSZ8061, MICREL_PHY_ID_MASK },
1409*4882a593Smuzhiyun 	{ PHY_ID_KSZ8081, MICREL_PHY_ID_MASK },
1410*4882a593Smuzhiyun 	{ PHY_ID_KSZ8873MLL, MICREL_PHY_ID_MASK },
1411*4882a593Smuzhiyun 	{ PHY_ID_KSZ886X, MICREL_PHY_ID_MASK },
1412*4882a593Smuzhiyun 	{ PHY_ID_LAN8814, MICREL_PHY_ID_MASK },
1413*4882a593Smuzhiyun 	{ }
1414*4882a593Smuzhiyun };
1415*4882a593Smuzhiyun 
1416*4882a593Smuzhiyun MODULE_DEVICE_TABLE(mdio, micrel_tbl);
1417