4 * SPDX-License-Identifier: GPL-2.0+
6 * Copyright 2010-2011 Freescale Semiconductor, Inc.
8 * (C) 2012 NetModule AG, David Andrey, added KSZ9031
9 * (C) Copyright 2017 Adaptrum, Inc.
10 * Written by Alexandru Gagniuc <alex.g@adaptrum.com> for Adaptrum, Inc.
20 DECLARE_GLOBAL_DATA_PTR;
23 * KSZ9021 - KSZ9031 common
26 #define MII_KSZ90xx_PHY_CTL 0x1f
27 #define MIIM_KSZ90xx_PHYCTL_1000 (1 << 6)
28 #define MIIM_KSZ90xx_PHYCTL_100 (1 << 5)
29 #define MIIM_KSZ90xx_PHYCTL_10 (1 << 4)
30 #define MIIM_KSZ90xx_PHYCTL_DUPLEX (1 << 3)
32 /* KSZ9021 PHY Registers */
33 #define MII_KSZ9021_EXTENDED_CTRL 0x0b
34 #define MII_KSZ9021_EXTENDED_DATAW 0x0c
35 #define MII_KSZ9021_EXTENDED_DATAR 0x0d
37 #define CTRL1000_PREFER_MASTER (1 << 10)
38 #define CTRL1000_CONFIG_MASTER (1 << 11)
39 #define CTRL1000_MANUAL_CONFIG (1 << 12)
41 /* KSZ9031 PHY Registers */
42 #define MII_KSZ9031_MMD_ACCES_CTRL 0x0d
43 #define MII_KSZ9031_MMD_REG_DATA 0x0e
45 static int ksz90xx_startup(struct phy_device *phydev)
50 ret = genphy_update_link(phydev);
54 phy_ctl = phy_read(phydev, MDIO_DEVAD_NONE, MII_KSZ90xx_PHY_CTL);
56 if (phy_ctl & MIIM_KSZ90xx_PHYCTL_DUPLEX)
57 phydev->duplex = DUPLEX_FULL;
59 phydev->duplex = DUPLEX_HALF;
61 if (phy_ctl & MIIM_KSZ90xx_PHYCTL_1000)
62 phydev->speed = SPEED_1000;
63 else if (phy_ctl & MIIM_KSZ90xx_PHYCTL_100)
64 phydev->speed = SPEED_100;
65 else if (phy_ctl & MIIM_KSZ90xx_PHYCTL_10)
66 phydev->speed = SPEED_10;
70 /* Common OF config bits for KSZ9021 and KSZ9031 */
72 struct ksz90x1_reg_field {
74 const u8 size; /* Size of the bitfield, in bits */
75 const u8 off; /* Offset from bit 0 */
76 const u8 dflt; /* Default value */
79 struct ksz90x1_ofcfg {
82 const struct ksz90x1_reg_field *grp;
86 static const struct ksz90x1_reg_field ksz90x1_rxd_grp[] = {
87 { "rxd0-skew-ps", 4, 0, 0x7 }, { "rxd1-skew-ps", 4, 4, 0x7 },
88 { "rxd2-skew-ps", 4, 8, 0x7 }, { "rxd3-skew-ps", 4, 12, 0x7 }
91 static const struct ksz90x1_reg_field ksz90x1_txd_grp[] = {
92 { "txd0-skew-ps", 4, 0, 0x7 }, { "txd1-skew-ps", 4, 4, 0x7 },
93 { "txd2-skew-ps", 4, 8, 0x7 }, { "txd3-skew-ps", 4, 12, 0x7 },
96 static const struct ksz90x1_reg_field ksz9021_clk_grp[] = {
97 { "txen-skew-ps", 4, 0, 0x7 }, { "txc-skew-ps", 4, 4, 0x7 },
98 { "rxdv-skew-ps", 4, 8, 0x7 }, { "rxc-skew-ps", 4, 12, 0x7 },
101 static const struct ksz90x1_reg_field ksz9031_ctl_grp[] = {
102 { "txen-skew-ps", 4, 0, 0x7 }, { "rxdv-skew-ps", 4, 4, 0x7 }
105 static const struct ksz90x1_reg_field ksz9031_clk_grp[] = {
106 { "rxc-skew-ps", 5, 0, 0xf }, { "txc-skew-ps", 5, 5, 0xf }
109 static int ksz90x1_of_config_group(struct phy_device *phydev,
110 struct ksz90x1_ofcfg *ofcfg)
112 struct udevice *dev = phydev->dev;
113 struct phy_driver *drv = phydev->drv;
114 const int ps_to_regval = 60;
116 int i, changed = 0, offset, max;
119 if (!drv || !drv->writeext)
122 for (i = 0; i < ofcfg->grpsz; i++) {
123 val[i] = fdtdec_get_uint(gd->fdt_blob, dev_of_offset(dev),
124 ofcfg->grp[i].name, -1);
125 offset = ofcfg->grp[i].off;
127 /* Default register value for KSZ9021 */
128 regval |= ofcfg->grp[i].dflt << offset;
130 changed = 1; /* Value was changed in OF */
131 /* Calculate the register value and fix corner cases */
132 if (val[i] > ps_to_regval * 0xf) {
133 max = (1 << ofcfg->grp[i].size) - 1;
134 regval |= max << offset;
136 regval |= (val[i] / ps_to_regval) << offset;
144 return drv->writeext(phydev, 0, ofcfg->devad, ofcfg->reg, regval);
147 static int ksz9021_of_config(struct phy_device *phydev)
149 struct ksz90x1_ofcfg ofcfg[] = {
150 { MII_KSZ9021_EXT_RGMII_RX_DATA_SKEW, 0, ksz90x1_rxd_grp, 4 },
151 { MII_KSZ9021_EXT_RGMII_TX_DATA_SKEW, 0, ksz90x1_txd_grp, 4 },
152 { MII_KSZ9021_EXT_RGMII_CLOCK_SKEW, 0, ksz9021_clk_grp, 4 },
156 for (i = 0; i < ARRAY_SIZE(ofcfg); i++) {
157 ret = ksz90x1_of_config_group(phydev, &(ofcfg[i]));
165 static int ksz9031_of_config(struct phy_device *phydev)
167 struct ksz90x1_ofcfg ofcfg[] = {
168 { MII_KSZ9031_EXT_RGMII_CTRL_SIG_SKEW, 2, ksz9031_ctl_grp, 2 },
169 { MII_KSZ9031_EXT_RGMII_RX_DATA_SKEW, 2, ksz90x1_rxd_grp, 4 },
170 { MII_KSZ9031_EXT_RGMII_TX_DATA_SKEW, 2, ksz90x1_txd_grp, 4 },
171 { MII_KSZ9031_EXT_RGMII_CLOCK_SKEW, 2, ksz9031_clk_grp, 2 },
175 for (i = 0; i < ARRAY_SIZE(ofcfg); i++) {
176 ret = ksz90x1_of_config_group(phydev, &(ofcfg[i]));
184 static int ksz9031_center_flp_timing(struct phy_device *phydev)
186 struct phy_driver *drv = phydev->drv;
189 if (!drv || !drv->writeext)
192 ret = drv->writeext(phydev, 0, 0, MII_KSZ9031_FLP_BURST_TX_LO, 0x1A80);
196 ret = drv->writeext(phydev, 0, 0, MII_KSZ9031_FLP_BURST_TX_HI, 0x6);
200 #else /* !CONFIG_DM_ETH */
201 static int ksz9021_of_config(struct phy_device *phydev)
206 static int ksz9031_of_config(struct phy_device *phydev)
211 static int ksz9031_center_flp_timing(struct phy_device *phydev)
220 int ksz9021_phy_extended_write(struct phy_device *phydev, int regnum, u16 val)
222 /* extended registers */
223 phy_write(phydev, MDIO_DEVAD_NONE,
224 MII_KSZ9021_EXTENDED_CTRL, regnum | 0x8000);
225 return phy_write(phydev, MDIO_DEVAD_NONE,
226 MII_KSZ9021_EXTENDED_DATAW, val);
229 int ksz9021_phy_extended_read(struct phy_device *phydev, int regnum)
231 /* extended registers */
232 phy_write(phydev, MDIO_DEVAD_NONE, MII_KSZ9021_EXTENDED_CTRL, regnum);
233 return phy_read(phydev, MDIO_DEVAD_NONE, MII_KSZ9021_EXTENDED_DATAR);
237 static int ksz9021_phy_extread(struct phy_device *phydev, int addr, int devaddr,
240 return ksz9021_phy_extended_read(phydev, regnum);
243 static int ksz9021_phy_extwrite(struct phy_device *phydev, int addr,
244 int devaddr, int regnum, u16 val)
246 return ksz9021_phy_extended_write(phydev, regnum, val);
249 static int ksz9021_config(struct phy_device *phydev)
251 unsigned ctrl1000 = 0;
252 const unsigned master = CTRL1000_PREFER_MASTER |
253 CTRL1000_CONFIG_MASTER | CTRL1000_MANUAL_CONFIG;
254 unsigned features = phydev->drv->features;
257 ret = ksz9021_of_config(phydev);
261 if (getenv("disable_giga"))
262 features &= ~(SUPPORTED_1000baseT_Half |
263 SUPPORTED_1000baseT_Full);
264 /* force master mode for 1000BaseT due to chip errata */
265 if (features & SUPPORTED_1000baseT_Half)
266 ctrl1000 |= ADVERTISE_1000HALF | master;
267 if (features & SUPPORTED_1000baseT_Full)
268 ctrl1000 |= ADVERTISE_1000FULL | master;
269 phydev->advertising = features;
270 phydev->supported = features;
271 phy_write(phydev, MDIO_DEVAD_NONE, MII_CTRL1000, ctrl1000);
272 genphy_config_aneg(phydev);
273 genphy_restart_aneg(phydev);
277 static struct phy_driver ksz9021_driver = {
278 .name = "Micrel ksz9021",
281 .features = PHY_GBIT_FEATURES,
282 .config = &ksz9021_config,
283 .startup = &ksz90xx_startup,
284 .shutdown = &genphy_shutdown,
285 .writeext = &ksz9021_phy_extwrite,
286 .readext = &ksz9021_phy_extread,
292 int ksz9031_phy_extended_write(struct phy_device *phydev,
293 int devaddr, int regnum, u16 mode, u16 val)
295 /*select register addr for mmd*/
296 phy_write(phydev, MDIO_DEVAD_NONE,
297 MII_KSZ9031_MMD_ACCES_CTRL, devaddr);
298 /*select register for mmd*/
299 phy_write(phydev, MDIO_DEVAD_NONE,
300 MII_KSZ9031_MMD_REG_DATA, regnum);
302 phy_write(phydev, MDIO_DEVAD_NONE,
303 MII_KSZ9031_MMD_ACCES_CTRL, (mode | devaddr));
305 return phy_write(phydev, MDIO_DEVAD_NONE,
306 MII_KSZ9031_MMD_REG_DATA, val);
309 int ksz9031_phy_extended_read(struct phy_device *phydev, int devaddr,
310 int regnum, u16 mode)
312 phy_write(phydev, MDIO_DEVAD_NONE,
313 MII_KSZ9031_MMD_ACCES_CTRL, devaddr);
314 phy_write(phydev, MDIO_DEVAD_NONE,
315 MII_KSZ9031_MMD_REG_DATA, regnum);
316 phy_write(phydev, MDIO_DEVAD_NONE,
317 MII_KSZ9031_MMD_ACCES_CTRL, (devaddr | mode));
318 return phy_read(phydev, MDIO_DEVAD_NONE, MII_KSZ9031_MMD_REG_DATA);
321 static int ksz9031_phy_extread(struct phy_device *phydev, int addr, int devaddr,
324 return ksz9031_phy_extended_read(phydev, devaddr, regnum,
325 MII_KSZ9031_MOD_DATA_NO_POST_INC);
328 static int ksz9031_phy_extwrite(struct phy_device *phydev, int addr,
329 int devaddr, int regnum, u16 val)
331 return ksz9031_phy_extended_write(phydev, devaddr, regnum,
332 MII_KSZ9031_MOD_DATA_POST_INC_RW, val);
335 static int ksz9031_config(struct phy_device *phydev)
339 ret = ksz9031_of_config(phydev);
342 ret = ksz9031_center_flp_timing(phydev);
346 /* add an option to disable the gigabit feature of this PHY */
347 if (getenv("disable_giga")) {
351 /* disable speed 1000 in features supported by the PHY */
352 features = phydev->drv->features;
353 features &= ~(SUPPORTED_1000baseT_Half |
354 SUPPORTED_1000baseT_Full);
355 phydev->advertising = phydev->supported = features;
357 /* disable speed 1000 in Basic Control Register */
358 bmcr = phy_read(phydev, MDIO_DEVAD_NONE, MII_BMCR);
360 phy_write(phydev, MDIO_DEVAD_NONE, MII_BMCR, bmcr);
362 /* disable speed 1000 in 1000Base-T Control Register */
363 phy_write(phydev, MDIO_DEVAD_NONE, MII_CTRL1000, 0);
366 genphy_config_aneg(phydev);
367 genphy_restart_aneg(phydev);
372 return genphy_config(phydev);
375 static struct phy_driver ksz9031_driver = {
376 .name = "Micrel ksz9031",
379 .features = PHY_GBIT_FEATURES,
380 .config = &ksz9031_config,
381 .startup = &ksz90xx_startup,
382 .shutdown = &genphy_shutdown,
383 .writeext = &ksz9031_phy_extwrite,
384 .readext = &ksz9031_phy_extread,
387 int phy_micrel_ksz90x1_init(void)
389 phy_register(&ksz9021_driver);
390 phy_register(&ksz9031_driver);