Tom Rini | 10e4779 | 2018-05-06 17:58:06 -0400 | [diff] [blame] | 1 | // SPDX-License-Identifier: GPL-2.0+ |
Andy Fleming | 60ca78b | 2011-04-07 21:56:05 -0500 | [diff] [blame] | 2 | /* |
| 3 | * Micrel PHY drivers |
| 4 | * |
Andy Fleming | 60ca78b | 2011-04-07 21:56:05 -0500 | [diff] [blame] | 5 | * Copyright 2010-2011 Freescale Semiconductor, Inc. |
| 6 | * author Andy Fleming |
David Andrey | f0d83c4 | 2013-02-06 22:18:37 +0100 | [diff] [blame] | 7 | * (C) 2012 NetModule AG, David Andrey, added KSZ9031 |
Alexandru Gagniuc | 757bb67 | 2017-07-07 11:36:57 -0700 | [diff] [blame] | 8 | * (C) Copyright 2017 Adaptrum, Inc. |
| 9 | * Written by Alexandru Gagniuc <alex.g@adaptrum.com> for Adaptrum, Inc. |
Andy Fleming | 60ca78b | 2011-04-07 21:56:05 -0500 | [diff] [blame] | 10 | */ |
Marek Vasut | 1005ce5 | 2015-12-05 17:41:58 +0100 | [diff] [blame] | 11 | #include <dm.h> |
Simon Glass | 0af6e2d | 2019-08-01 09:46:52 -0600 | [diff] [blame] | 12 | #include <env.h> |
Marek Vasut | 1005ce5 | 2015-12-05 17:41:58 +0100 | [diff] [blame] | 13 | #include <errno.h> |
Troy Kisky | 80b6b09 | 2012-02-07 14:08:48 +0000 | [diff] [blame] | 14 | #include <micrel.h> |
Andy Fleming | 60ca78b | 2011-04-07 21:56:05 -0500 | [diff] [blame] | 15 | #include <phy.h> |
| 16 | |
Pavel Machek | 5f02211 | 2014-09-09 14:26:51 +0200 | [diff] [blame] | 17 | /* |
David Andrey | f0d83c4 | 2013-02-06 22:18:37 +0100 | [diff] [blame] | 18 | * KSZ9021 - KSZ9031 common |
| 19 | */ |
| 20 | |
| 21 | #define MII_KSZ90xx_PHY_CTL 0x1f |
| 22 | #define MIIM_KSZ90xx_PHYCTL_1000 (1 << 6) |
| 23 | #define MIIM_KSZ90xx_PHYCTL_100 (1 << 5) |
| 24 | #define MIIM_KSZ90xx_PHYCTL_10 (1 << 4) |
| 25 | #define MIIM_KSZ90xx_PHYCTL_DUPLEX (1 << 3) |
| 26 | |
Alexandru Gagniuc | 757bb67 | 2017-07-07 11:36:57 -0700 | [diff] [blame] | 27 | /* KSZ9021 PHY Registers */ |
| 28 | #define MII_KSZ9021_EXTENDED_CTRL 0x0b |
| 29 | #define MII_KSZ9021_EXTENDED_DATAW 0x0c |
| 30 | #define MII_KSZ9021_EXTENDED_DATAR 0x0d |
| 31 | |
| 32 | #define CTRL1000_PREFER_MASTER (1 << 10) |
| 33 | #define CTRL1000_CONFIG_MASTER (1 << 11) |
| 34 | #define CTRL1000_MANUAL_CONFIG (1 << 12) |
| 35 | |
James Byrne | 457107f | 2019-03-04 17:40:33 +0000 | [diff] [blame] | 36 | #define KSZ9021_PS_TO_REG 120 |
| 37 | |
Alexandru Gagniuc | 757bb67 | 2017-07-07 11:36:57 -0700 | [diff] [blame] | 38 | /* KSZ9031 PHY Registers */ |
| 39 | #define MII_KSZ9031_MMD_ACCES_CTRL 0x0d |
| 40 | #define MII_KSZ9031_MMD_REG_DATA 0x0e |
| 41 | |
James Byrne | 457107f | 2019-03-04 17:40:33 +0000 | [diff] [blame] | 42 | #define KSZ9031_PS_TO_REG 60 |
| 43 | |
David Andrey | f0d83c4 | 2013-02-06 22:18:37 +0100 | [diff] [blame] | 44 | static int ksz90xx_startup(struct phy_device *phydev) |
| 45 | { |
| 46 | unsigned phy_ctl; |
Michal Simek | 5ff8966 | 2016-05-18 12:46:12 +0200 | [diff] [blame] | 47 | int ret; |
| 48 | |
| 49 | ret = genphy_update_link(phydev); |
| 50 | if (ret) |
| 51 | return ret; |
| 52 | |
David Andrey | f0d83c4 | 2013-02-06 22:18:37 +0100 | [diff] [blame] | 53 | phy_ctl = phy_read(phydev, MDIO_DEVAD_NONE, MII_KSZ90xx_PHY_CTL); |
| 54 | |
| 55 | if (phy_ctl & MIIM_KSZ90xx_PHYCTL_DUPLEX) |
| 56 | phydev->duplex = DUPLEX_FULL; |
| 57 | else |
| 58 | phydev->duplex = DUPLEX_HALF; |
| 59 | |
| 60 | if (phy_ctl & MIIM_KSZ90xx_PHYCTL_1000) |
| 61 | phydev->speed = SPEED_1000; |
| 62 | else if (phy_ctl & MIIM_KSZ90xx_PHYCTL_100) |
| 63 | phydev->speed = SPEED_100; |
| 64 | else if (phy_ctl & MIIM_KSZ90xx_PHYCTL_10) |
| 65 | phydev->speed = SPEED_10; |
| 66 | return 0; |
| 67 | } |
David Andrey | f0d83c4 | 2013-02-06 22:18:37 +0100 | [diff] [blame] | 68 | |
Marek Vasut | 1005ce5 | 2015-12-05 17:41:58 +0100 | [diff] [blame] | 69 | /* Common OF config bits for KSZ9021 and KSZ9031 */ |
Marek Vasut | 1005ce5 | 2015-12-05 17:41:58 +0100 | [diff] [blame] | 70 | struct ksz90x1_reg_field { |
| 71 | const char *name; |
| 72 | const u8 size; /* Size of the bitfield, in bits */ |
| 73 | const u8 off; /* Offset from bit 0 */ |
| 74 | const u8 dflt; /* Default value */ |
| 75 | }; |
| 76 | |
| 77 | struct ksz90x1_ofcfg { |
| 78 | const u16 reg; |
| 79 | const u16 devad; |
| 80 | const struct ksz90x1_reg_field *grp; |
| 81 | const u16 grpsz; |
| 82 | }; |
| 83 | |
| 84 | static const struct ksz90x1_reg_field ksz90x1_rxd_grp[] = { |
| 85 | { "rxd0-skew-ps", 4, 0, 0x7 }, { "rxd1-skew-ps", 4, 4, 0x7 }, |
| 86 | { "rxd2-skew-ps", 4, 8, 0x7 }, { "rxd3-skew-ps", 4, 12, 0x7 } |
| 87 | }; |
| 88 | |
| 89 | static const struct ksz90x1_reg_field ksz90x1_txd_grp[] = { |
| 90 | { "txd0-skew-ps", 4, 0, 0x7 }, { "txd1-skew-ps", 4, 4, 0x7 }, |
| 91 | { "txd2-skew-ps", 4, 8, 0x7 }, { "txd3-skew-ps", 4, 12, 0x7 }, |
| 92 | }; |
| 93 | |
Alexandru Gagniuc | 757bb67 | 2017-07-07 11:36:57 -0700 | [diff] [blame] | 94 | static const struct ksz90x1_reg_field ksz9021_clk_grp[] = { |
| 95 | { "txen-skew-ps", 4, 0, 0x7 }, { "txc-skew-ps", 4, 4, 0x7 }, |
| 96 | { "rxdv-skew-ps", 4, 8, 0x7 }, { "rxc-skew-ps", 4, 12, 0x7 }, |
| 97 | }; |
| 98 | |
| 99 | static const struct ksz90x1_reg_field ksz9031_ctl_grp[] = { |
| 100 | { "txen-skew-ps", 4, 0, 0x7 }, { "rxdv-skew-ps", 4, 4, 0x7 } |
| 101 | }; |
| 102 | |
| 103 | static const struct ksz90x1_reg_field ksz9031_clk_grp[] = { |
| 104 | { "rxc-skew-ps", 5, 0, 0xf }, { "txc-skew-ps", 5, 5, 0xf } |
| 105 | }; |
| 106 | |
Marek Vasut | 1005ce5 | 2015-12-05 17:41:58 +0100 | [diff] [blame] | 107 | static int ksz90x1_of_config_group(struct phy_device *phydev, |
James Byrne | 457107f | 2019-03-04 17:40:33 +0000 | [diff] [blame] | 108 | struct ksz90x1_ofcfg *ofcfg, |
| 109 | int ps_to_regval) |
Marek Vasut | 1005ce5 | 2015-12-05 17:41:58 +0100 | [diff] [blame] | 110 | { |
| 111 | struct udevice *dev = phydev->dev; |
| 112 | struct phy_driver *drv = phydev->drv; |
Marek Vasut | 1005ce5 | 2015-12-05 17:41:58 +0100 | [diff] [blame] | 113 | int val[4]; |
| 114 | int i, changed = 0, offset, max; |
| 115 | u16 regval = 0; |
James Byrne | 9e79144 | 2019-03-04 17:40:34 +0000 | [diff] [blame] | 116 | ofnode node; |
Marek Vasut | 1005ce5 | 2015-12-05 17:41:58 +0100 | [diff] [blame] | 117 | |
| 118 | if (!drv || !drv->writeext) |
| 119 | return -EOPNOTSUPP; |
| 120 | |
Marek Vasut | 7bbc25b | 2021-01-17 00:16:16 +0100 | [diff] [blame] | 121 | node = phydev->node; |
| 122 | |
| 123 | if (!ofnode_valid(node)) { |
| 124 | /* Look for a PHY node under the Ethernet node */ |
| 125 | node = dev_read_subnode(dev, "ethernet-phy"); |
| 126 | } |
| 127 | |
James Byrne | 9e79144 | 2019-03-04 17:40:34 +0000 | [diff] [blame] | 128 | if (!ofnode_valid(node)) { |
| 129 | /* No node found, look in the Ethernet node */ |
| 130 | node = dev_ofnode(dev); |
| 131 | } |
| 132 | |
Marek Vasut | 1005ce5 | 2015-12-05 17:41:58 +0100 | [diff] [blame] | 133 | for (i = 0; i < ofcfg->grpsz; i++) { |
James Byrne | 9e79144 | 2019-03-04 17:40:34 +0000 | [diff] [blame] | 134 | val[i] = ofnode_read_u32_default(node, ofcfg->grp[i].name, ~0); |
Marek Vasut | 1005ce5 | 2015-12-05 17:41:58 +0100 | [diff] [blame] | 135 | offset = ofcfg->grp[i].off; |
| 136 | if (val[i] == -1) { |
| 137 | /* Default register value for KSZ9021 */ |
| 138 | regval |= ofcfg->grp[i].dflt << offset; |
| 139 | } else { |
| 140 | changed = 1; /* Value was changed in OF */ |
| 141 | /* Calculate the register value and fix corner cases */ |
Andreas Pretzsch | f7c689d | 2018-11-29 20:04:53 +0100 | [diff] [blame] | 142 | max = (1 << ofcfg->grp[i].size) - 1; |
| 143 | if (val[i] > ps_to_regval * max) { |
Marek Vasut | 1005ce5 | 2015-12-05 17:41:58 +0100 | [diff] [blame] | 144 | regval |= max << offset; |
| 145 | } else { |
| 146 | regval |= (val[i] / ps_to_regval) << offset; |
| 147 | } |
| 148 | } |
| 149 | } |
| 150 | |
| 151 | if (!changed) |
| 152 | return 0; |
| 153 | |
| 154 | return drv->writeext(phydev, 0, ofcfg->devad, ofcfg->reg, regval); |
| 155 | } |
Marek Vasut | 1005ce5 | 2015-12-05 17:41:58 +0100 | [diff] [blame] | 156 | |
| 157 | static int ksz9021_of_config(struct phy_device *phydev) |
| 158 | { |
| 159 | struct ksz90x1_ofcfg ofcfg[] = { |
| 160 | { MII_KSZ9021_EXT_RGMII_RX_DATA_SKEW, 0, ksz90x1_rxd_grp, 4 }, |
| 161 | { MII_KSZ9021_EXT_RGMII_TX_DATA_SKEW, 0, ksz90x1_txd_grp, 4 }, |
| 162 | { MII_KSZ9021_EXT_RGMII_CLOCK_SKEW, 0, ksz9021_clk_grp, 4 }, |
| 163 | }; |
| 164 | int i, ret = 0; |
| 165 | |
Marek Vasut | 0c76630 | 2016-11-14 15:08:42 +0100 | [diff] [blame] | 166 | for (i = 0; i < ARRAY_SIZE(ofcfg); i++) { |
James Byrne | 457107f | 2019-03-04 17:40:33 +0000 | [diff] [blame] | 167 | ret = ksz90x1_of_config_group(phydev, &ofcfg[i], |
| 168 | KSZ9021_PS_TO_REG); |
Marek Vasut | 1005ce5 | 2015-12-05 17:41:58 +0100 | [diff] [blame] | 169 | if (ret) |
| 170 | return ret; |
Marek Vasut | 0c76630 | 2016-11-14 15:08:42 +0100 | [diff] [blame] | 171 | } |
Marek Vasut | 1005ce5 | 2015-12-05 17:41:58 +0100 | [diff] [blame] | 172 | |
| 173 | return 0; |
| 174 | } |
Alexandru Gagniuc | 757bb67 | 2017-07-07 11:36:57 -0700 | [diff] [blame] | 175 | |
| 176 | static int ksz9031_of_config(struct phy_device *phydev) |
| 177 | { |
| 178 | struct ksz90x1_ofcfg ofcfg[] = { |
| 179 | { MII_KSZ9031_EXT_RGMII_CTRL_SIG_SKEW, 2, ksz9031_ctl_grp, 2 }, |
| 180 | { MII_KSZ9031_EXT_RGMII_RX_DATA_SKEW, 2, ksz90x1_rxd_grp, 4 }, |
| 181 | { MII_KSZ9031_EXT_RGMII_TX_DATA_SKEW, 2, ksz90x1_txd_grp, 4 }, |
| 182 | { MII_KSZ9031_EXT_RGMII_CLOCK_SKEW, 2, ksz9031_clk_grp, 2 }, |
| 183 | }; |
| 184 | int i, ret = 0; |
| 185 | |
| 186 | for (i = 0; i < ARRAY_SIZE(ofcfg); i++) { |
James Byrne | 457107f | 2019-03-04 17:40:33 +0000 | [diff] [blame] | 187 | ret = ksz90x1_of_config_group(phydev, &ofcfg[i], |
| 188 | KSZ9031_PS_TO_REG); |
Alexandru Gagniuc | 757bb67 | 2017-07-07 11:36:57 -0700 | [diff] [blame] | 189 | if (ret) |
| 190 | return ret; |
| 191 | } |
| 192 | |
| 193 | return 0; |
| 194 | } |
| 195 | |
| 196 | static int ksz9031_center_flp_timing(struct phy_device *phydev) |
| 197 | { |
| 198 | struct phy_driver *drv = phydev->drv; |
| 199 | int ret = 0; |
| 200 | |
| 201 | if (!drv || !drv->writeext) |
| 202 | return -EOPNOTSUPP; |
| 203 | |
| 204 | ret = drv->writeext(phydev, 0, 0, MII_KSZ9031_FLP_BURST_TX_LO, 0x1A80); |
| 205 | if (ret) |
| 206 | return ret; |
| 207 | |
| 208 | ret = drv->writeext(phydev, 0, 0, MII_KSZ9031_FLP_BURST_TX_HI, 0x6); |
| 209 | return ret; |
| 210 | } |
| 211 | |
Alexandru Gagniuc | 757bb67 | 2017-07-07 11:36:57 -0700 | [diff] [blame] | 212 | /* |
| 213 | * KSZ9021 |
| 214 | */ |
Troy Kisky | 80b6b09 | 2012-02-07 14:08:48 +0000 | [diff] [blame] | 215 | int ksz9021_phy_extended_write(struct phy_device *phydev, int regnum, u16 val) |
| 216 | { |
| 217 | /* extended registers */ |
| 218 | phy_write(phydev, MDIO_DEVAD_NONE, |
Alexandru Gagniuc | 757bb67 | 2017-07-07 11:36:57 -0700 | [diff] [blame] | 219 | MII_KSZ9021_EXTENDED_CTRL, regnum | 0x8000); |
Troy Kisky | 80b6b09 | 2012-02-07 14:08:48 +0000 | [diff] [blame] | 220 | return phy_write(phydev, MDIO_DEVAD_NONE, |
Alexandru Gagniuc | 757bb67 | 2017-07-07 11:36:57 -0700 | [diff] [blame] | 221 | MII_KSZ9021_EXTENDED_DATAW, val); |
Troy Kisky | 80b6b09 | 2012-02-07 14:08:48 +0000 | [diff] [blame] | 222 | } |
| 223 | |
| 224 | int ksz9021_phy_extended_read(struct phy_device *phydev, int regnum) |
| 225 | { |
| 226 | /* extended registers */ |
| 227 | phy_write(phydev, MDIO_DEVAD_NONE, MII_KSZ9021_EXTENDED_CTRL, regnum); |
| 228 | return phy_read(phydev, MDIO_DEVAD_NONE, MII_KSZ9021_EXTENDED_DATAR); |
| 229 | } |
| 230 | |
Stefano Babic | a8aa299 | 2013-09-02 15:42:31 +0200 | [diff] [blame] | 231 | static int ksz9021_phy_extread(struct phy_device *phydev, int addr, int devaddr, |
Alexandru Gagniuc | 757bb67 | 2017-07-07 11:36:57 -0700 | [diff] [blame] | 232 | int regnum) |
Stefano Babic | a8aa299 | 2013-09-02 15:42:31 +0200 | [diff] [blame] | 233 | { |
| 234 | return ksz9021_phy_extended_read(phydev, regnum); |
| 235 | } |
| 236 | |
| 237 | static int ksz9021_phy_extwrite(struct phy_device *phydev, int addr, |
Alexandru Gagniuc | 757bb67 | 2017-07-07 11:36:57 -0700 | [diff] [blame] | 238 | int devaddr, int regnum, u16 val) |
Stefano Babic | a8aa299 | 2013-09-02 15:42:31 +0200 | [diff] [blame] | 239 | { |
| 240 | return ksz9021_phy_extended_write(phydev, regnum, val); |
| 241 | } |
| 242 | |
Troy Kisky | 80b6b09 | 2012-02-07 14:08:48 +0000 | [diff] [blame] | 243 | static int ksz9021_config(struct phy_device *phydev) |
| 244 | { |
| 245 | unsigned ctrl1000 = 0; |
| 246 | const unsigned master = CTRL1000_PREFER_MASTER | |
Alexandru Gagniuc | 757bb67 | 2017-07-07 11:36:57 -0700 | [diff] [blame] | 247 | CTRL1000_CONFIG_MASTER | CTRL1000_MANUAL_CONFIG; |
Troy Kisky | 80b6b09 | 2012-02-07 14:08:48 +0000 | [diff] [blame] | 248 | unsigned features = phydev->drv->features; |
Marek Vasut | 1005ce5 | 2015-12-05 17:41:58 +0100 | [diff] [blame] | 249 | int ret; |
| 250 | |
| 251 | ret = ksz9021_of_config(phydev); |
| 252 | if (ret) |
| 253 | return ret; |
Troy Kisky | 80b6b09 | 2012-02-07 14:08:48 +0000 | [diff] [blame] | 254 | |
Simon Glass | 64b723f | 2017-08-03 12:22:12 -0600 | [diff] [blame] | 255 | if (env_get("disable_giga")) |
Troy Kisky | 80b6b09 | 2012-02-07 14:08:48 +0000 | [diff] [blame] | 256 | features &= ~(SUPPORTED_1000baseT_Half | |
Alexandru Gagniuc | 757bb67 | 2017-07-07 11:36:57 -0700 | [diff] [blame] | 257 | SUPPORTED_1000baseT_Full); |
Troy Kisky | 80b6b09 | 2012-02-07 14:08:48 +0000 | [diff] [blame] | 258 | /* force master mode for 1000BaseT due to chip errata */ |
| 259 | if (features & SUPPORTED_1000baseT_Half) |
| 260 | ctrl1000 |= ADVERTISE_1000HALF | master; |
| 261 | if (features & SUPPORTED_1000baseT_Full) |
| 262 | ctrl1000 |= ADVERTISE_1000FULL | master; |
Alexandru Gagniuc | 757bb67 | 2017-07-07 11:36:57 -0700 | [diff] [blame] | 263 | phydev->advertising = features; |
| 264 | phydev->supported = features; |
Troy Kisky | 80b6b09 | 2012-02-07 14:08:48 +0000 | [diff] [blame] | 265 | phy_write(phydev, MDIO_DEVAD_NONE, MII_CTRL1000, ctrl1000); |
| 266 | genphy_config_aneg(phydev); |
| 267 | genphy_restart_aneg(phydev); |
| 268 | return 0; |
| 269 | } |
| 270 | |
Marek Vasut | ce250e9 | 2023-03-19 18:02:56 +0100 | [diff] [blame] | 271 | U_BOOT_PHY_DRIVER(ksz9021) = { |
Troy Kisky | 80b6b09 | 2012-02-07 14:08:48 +0000 | [diff] [blame] | 272 | .name = "Micrel ksz9021", |
| 273 | .uid = 0x221610, |
James Byrne | bc292c2 | 2019-03-06 12:48:27 +0000 | [diff] [blame] | 274 | .mask = 0xfffffe, |
Troy Kisky | 80b6b09 | 2012-02-07 14:08:48 +0000 | [diff] [blame] | 275 | .features = PHY_GBIT_FEATURES, |
| 276 | .config = &ksz9021_config, |
David Andrey | f0d83c4 | 2013-02-06 22:18:37 +0100 | [diff] [blame] | 277 | .startup = &ksz90xx_startup, |
Troy Kisky | 80b6b09 | 2012-02-07 14:08:48 +0000 | [diff] [blame] | 278 | .shutdown = &genphy_shutdown, |
Stefano Babic | a8aa299 | 2013-09-02 15:42:31 +0200 | [diff] [blame] | 279 | .writeext = &ksz9021_phy_extwrite, |
| 280 | .readext = &ksz9021_phy_extread, |
Troy Kisky | 80b6b09 | 2012-02-07 14:08:48 +0000 | [diff] [blame] | 281 | }; |
| 282 | |
Alexandru Gagniuc | 757bb67 | 2017-07-07 11:36:57 -0700 | [diff] [blame] | 283 | /* |
David Andrey | f0d83c4 | 2013-02-06 22:18:37 +0100 | [diff] [blame] | 284 | * KSZ9031 |
| 285 | */ |
SARTRE Leo | eaf68ac | 2013-04-30 16:57:25 +0200 | [diff] [blame] | 286 | int ksz9031_phy_extended_write(struct phy_device *phydev, |
| 287 | int devaddr, int regnum, u16 mode, u16 val) |
| 288 | { |
| 289 | /*select register addr for mmd*/ |
| 290 | phy_write(phydev, MDIO_DEVAD_NONE, |
| 291 | MII_KSZ9031_MMD_ACCES_CTRL, devaddr); |
| 292 | /*select register for mmd*/ |
| 293 | phy_write(phydev, MDIO_DEVAD_NONE, |
| 294 | MII_KSZ9031_MMD_REG_DATA, regnum); |
| 295 | /*setup mode*/ |
| 296 | phy_write(phydev, MDIO_DEVAD_NONE, |
| 297 | MII_KSZ9031_MMD_ACCES_CTRL, (mode | devaddr)); |
| 298 | /*write the value*/ |
| 299 | return phy_write(phydev, MDIO_DEVAD_NONE, |
Alexandru Gagniuc | 757bb67 | 2017-07-07 11:36:57 -0700 | [diff] [blame] | 300 | MII_KSZ9031_MMD_REG_DATA, val); |
SARTRE Leo | eaf68ac | 2013-04-30 16:57:25 +0200 | [diff] [blame] | 301 | } |
| 302 | |
| 303 | int ksz9031_phy_extended_read(struct phy_device *phydev, int devaddr, |
| 304 | int regnum, u16 mode) |
| 305 | { |
| 306 | phy_write(phydev, MDIO_DEVAD_NONE, |
| 307 | MII_KSZ9031_MMD_ACCES_CTRL, devaddr); |
| 308 | phy_write(phydev, MDIO_DEVAD_NONE, |
| 309 | MII_KSZ9031_MMD_REG_DATA, regnum); |
| 310 | phy_write(phydev, MDIO_DEVAD_NONE, |
| 311 | MII_KSZ9031_MMD_ACCES_CTRL, (devaddr | mode)); |
| 312 | return phy_read(phydev, MDIO_DEVAD_NONE, MII_KSZ9031_MMD_REG_DATA); |
| 313 | } |
| 314 | |
Stefano Babic | a8aa299 | 2013-09-02 15:42:31 +0200 | [diff] [blame] | 315 | static int ksz9031_phy_extread(struct phy_device *phydev, int addr, int devaddr, |
| 316 | int regnum) |
| 317 | { |
| 318 | return ksz9031_phy_extended_read(phydev, devaddr, regnum, |
| 319 | MII_KSZ9031_MOD_DATA_NO_POST_INC); |
Alexandru Gagniuc | 757bb67 | 2017-07-07 11:36:57 -0700 | [diff] [blame] | 320 | } |
Stefano Babic | a8aa299 | 2013-09-02 15:42:31 +0200 | [diff] [blame] | 321 | |
| 322 | static int ksz9031_phy_extwrite(struct phy_device *phydev, int addr, |
| 323 | int devaddr, int regnum, u16 val) |
| 324 | { |
| 325 | return ksz9031_phy_extended_write(phydev, devaddr, regnum, |
Alexandru Gagniuc | 757bb67 | 2017-07-07 11:36:57 -0700 | [diff] [blame] | 326 | MII_KSZ9031_MOD_DATA_POST_INC_RW, val); |
| 327 | } |
Stefano Babic | a8aa299 | 2013-09-02 15:42:31 +0200 | [diff] [blame] | 328 | |
Marek Vasut | 1005ce5 | 2015-12-05 17:41:58 +0100 | [diff] [blame] | 329 | static int ksz9031_config(struct phy_device *phydev) |
| 330 | { |
| 331 | int ret; |
Sebastien Bourdelin | 3a6e033 | 2017-07-28 15:59:22 -0400 | [diff] [blame] | 332 | |
Marek Vasut | 1005ce5 | 2015-12-05 17:41:58 +0100 | [diff] [blame] | 333 | ret = ksz9031_of_config(phydev); |
| 334 | if (ret) |
| 335 | return ret; |
Ash Charles | 3f55bb6 | 2016-10-21 17:31:33 -0400 | [diff] [blame] | 336 | ret = ksz9031_center_flp_timing(phydev); |
| 337 | if (ret) |
| 338 | return ret; |
Sebastien Bourdelin | 3a6e033 | 2017-07-28 15:59:22 -0400 | [diff] [blame] | 339 | |
| 340 | /* add an option to disable the gigabit feature of this PHY */ |
Simon Glass | 64b723f | 2017-08-03 12:22:12 -0600 | [diff] [blame] | 341 | if (env_get("disable_giga")) { |
Sebastien Bourdelin | 3a6e033 | 2017-07-28 15:59:22 -0400 | [diff] [blame] | 342 | unsigned features; |
| 343 | unsigned bmcr; |
| 344 | |
| 345 | /* disable speed 1000 in features supported by the PHY */ |
| 346 | features = phydev->drv->features; |
| 347 | features &= ~(SUPPORTED_1000baseT_Half | |
| 348 | SUPPORTED_1000baseT_Full); |
| 349 | phydev->advertising = phydev->supported = features; |
| 350 | |
| 351 | /* disable speed 1000 in Basic Control Register */ |
| 352 | bmcr = phy_read(phydev, MDIO_DEVAD_NONE, MII_BMCR); |
| 353 | bmcr &= ~(1 << 6); |
| 354 | phy_write(phydev, MDIO_DEVAD_NONE, MII_BMCR, bmcr); |
| 355 | |
| 356 | /* disable speed 1000 in 1000Base-T Control Register */ |
| 357 | phy_write(phydev, MDIO_DEVAD_NONE, MII_CTRL1000, 0); |
| 358 | |
| 359 | /* start autoneg */ |
| 360 | genphy_config_aneg(phydev); |
| 361 | genphy_restart_aneg(phydev); |
| 362 | |
| 363 | return 0; |
| 364 | } |
| 365 | |
Marek Vasut | 1005ce5 | 2015-12-05 17:41:58 +0100 | [diff] [blame] | 366 | return genphy_config(phydev); |
| 367 | } |
Stefano Babic | a8aa299 | 2013-09-02 15:42:31 +0200 | [diff] [blame] | 368 | |
Marek Vasut | ce250e9 | 2023-03-19 18:02:56 +0100 | [diff] [blame] | 369 | U_BOOT_PHY_DRIVER(ksz9031) = { |
David Andrey | f0d83c4 | 2013-02-06 22:18:37 +0100 | [diff] [blame] | 370 | .name = "Micrel ksz9031", |
Philippe Schenker | be98837 | 2020-03-11 11:59:22 +0100 | [diff] [blame] | 371 | .uid = PHY_ID_KSZ9031, |
| 372 | .mask = MII_KSZ9x31_SILICON_REV_MASK, |
David Andrey | f0d83c4 | 2013-02-06 22:18:37 +0100 | [diff] [blame] | 373 | .features = PHY_GBIT_FEATURES, |
Marek Vasut | 1005ce5 | 2015-12-05 17:41:58 +0100 | [diff] [blame] | 374 | .config = &ksz9031_config, |
David Andrey | f0d83c4 | 2013-02-06 22:18:37 +0100 | [diff] [blame] | 375 | .startup = &ksz90xx_startup, |
| 376 | .shutdown = &genphy_shutdown, |
Stefano Babic | a8aa299 | 2013-09-02 15:42:31 +0200 | [diff] [blame] | 377 | .writeext = &ksz9031_phy_extwrite, |
| 378 | .readext = &ksz9031_phy_extread, |
David Andrey | f0d83c4 | 2013-02-06 22:18:37 +0100 | [diff] [blame] | 379 | }; |
| 380 | |
Philippe Schenker | 3060ecc | 2020-03-11 11:59:23 +0100 | [diff] [blame] | 381 | /* |
| 382 | * KSZ9131 |
| 383 | */ |
Claudiu Beznea | 840a6b0 | 2020-12-03 11:18:30 +0200 | [diff] [blame] | 384 | |
| 385 | #define KSZ9131RN_MMD_COMMON_CTRL_REG 2 |
| 386 | #define KSZ9131RN_RXC_DLL_CTRL 76 |
| 387 | #define KSZ9131RN_TXC_DLL_CTRL 77 |
| 388 | #define KSZ9131RN_DLL_CTRL_BYPASS BIT_MASK(12) |
| 389 | #define KSZ9131RN_DLL_ENABLE_DELAY 0 |
| 390 | #define KSZ9131RN_DLL_DISABLE_DELAY BIT(12) |
| 391 | |
Paul Barker | ef6bef6 | 2025-02-28 12:47:53 +0000 | [diff] [blame] | 392 | #define KSZ9131RN_COMMON_CTRL 0 |
| 393 | #define KSZ9131RN_COMMON_CTRL_INDIVIDUAL_LED_MODE BIT(4) |
| 394 | |
| 395 | #define KSZ9131RN_LED_ERRATA_REG 0x1e |
| 396 | #define KSZ9131RN_LED_ERRATA_BIT BIT(9) |
| 397 | |
Paul Barker | 59beaf3 | 2025-02-28 12:47:54 +0000 | [diff] [blame^] | 398 | #define KSZ9131RN_CONTROL_PAD_SKEW 4 |
| 399 | #define KSZ9131RN_RX_DATA_PAD_SKEW 5 |
| 400 | #define KSZ9131RN_TX_DATA_PAD_SKEW 6 |
| 401 | #define KSZ9131RN_CLK_PAD_SKEW 8 |
| 402 | |
| 403 | #define KSZ9131RN_SKEW_5BIT_MAX 2400 |
| 404 | #define KSZ9131RN_SKEW_4BIT_MAX 800 |
| 405 | #define KSZ9131RN_OFFSET 700 |
| 406 | #define KSZ9131RN_STEP 100 |
| 407 | |
| 408 | static int ksz9131_of_load_skew_values(struct phy_device *phydev, |
| 409 | ofnode of_node, |
| 410 | u16 reg, size_t field_sz, |
| 411 | const char *field[], u8 numfields) |
| 412 | { |
| 413 | int val[4] = {-(1 + KSZ9131RN_OFFSET), -(2 + KSZ9131RN_OFFSET), |
| 414 | -(3 + KSZ9131RN_OFFSET), -(4 + KSZ9131RN_OFFSET)}; |
| 415 | int skewval, skewmax = 0; |
| 416 | int matches = 0; |
| 417 | u16 maxval; |
| 418 | u16 newval; |
| 419 | u16 mask; |
| 420 | int i; |
| 421 | |
| 422 | /* psec properties in dts should mean x pico seconds */ |
| 423 | if (field_sz == 5) |
| 424 | skewmax = KSZ9131RN_SKEW_5BIT_MAX; |
| 425 | else |
| 426 | skewmax = KSZ9131RN_SKEW_4BIT_MAX; |
| 427 | |
| 428 | for (i = 0; i < numfields; i++) |
| 429 | if (!ofnode_read_s32(of_node, field[i], &skewval)) { |
| 430 | if (skewval < -KSZ9131RN_OFFSET) |
| 431 | skewval = -KSZ9131RN_OFFSET; |
| 432 | else if (skewval > skewmax) |
| 433 | skewval = skewmax; |
| 434 | |
| 435 | val[i] = skewval + KSZ9131RN_OFFSET; |
| 436 | matches++; |
| 437 | } |
| 438 | |
| 439 | if (!matches) |
| 440 | return 0; |
| 441 | |
| 442 | if (matches < numfields) |
| 443 | newval = phy_read_mmd(phydev, KSZ9131RN_MMD_COMMON_CTRL_REG, reg); |
| 444 | else |
| 445 | newval = 0; |
| 446 | |
| 447 | maxval = (field_sz == 4) ? 0xf : 0x1f; |
| 448 | for (i = 0; i < numfields; i++) |
| 449 | if (val[i] != -(i + 1 + KSZ9131RN_OFFSET)) { |
| 450 | mask = 0xffff; |
| 451 | mask ^= maxval << (field_sz * i); |
| 452 | newval = (newval & mask) | |
| 453 | (((val[i] / KSZ9131RN_STEP) & maxval) |
| 454 | << (field_sz * i)); |
| 455 | } |
| 456 | |
| 457 | return phy_write_mmd(phydev, KSZ9131RN_MMD_COMMON_CTRL_REG, reg, newval); |
| 458 | } |
| 459 | |
| 460 | static int ksz9131_of_load_all_skew_values(struct phy_device *phydev) |
| 461 | { |
| 462 | const char *control_skews[2] = { "txen-skew-psec", "rxdv-skew-psec" }; |
| 463 | const char *clk_skews[2] = { "rxc-skew-psec", "txc-skew-psec" }; |
| 464 | const char *rx_data_skews[4] = { |
| 465 | "rxd0-skew-psec", "rxd1-skew-psec", |
| 466 | "rxd2-skew-psec", "rxd3-skew-psec" |
| 467 | }; |
| 468 | const char *tx_data_skews[4] = { |
| 469 | "txd0-skew-psec", "txd1-skew-psec", |
| 470 | "txd2-skew-psec", "txd3-skew-psec" |
| 471 | }; |
| 472 | struct ofnode_phandle_args phandle_args; |
| 473 | int ret; |
| 474 | |
| 475 | /* |
| 476 | * Silently ignore failure here as the device tree is not required to |
| 477 | * contain a phy node. |
| 478 | */ |
| 479 | if (dev_read_phandle_with_args(phydev->dev, "phy-handle", NULL, 0, 0, |
| 480 | &phandle_args)) |
| 481 | return 0; |
| 482 | |
| 483 | if (!ofnode_valid(phandle_args.node)) |
| 484 | return 0; |
| 485 | |
| 486 | ret = ksz9131_of_load_skew_values(phydev, phandle_args.node, |
| 487 | KSZ9131RN_CLK_PAD_SKEW, 5, |
| 488 | clk_skews, 2); |
| 489 | if (ret < 0) |
| 490 | return ret; |
| 491 | |
| 492 | ret = ksz9131_of_load_skew_values(phydev, phandle_args.node, |
| 493 | KSZ9131RN_CONTROL_PAD_SKEW, 4, |
| 494 | control_skews, 2); |
| 495 | if (ret < 0) |
| 496 | return ret; |
| 497 | |
| 498 | ret = ksz9131_of_load_skew_values(phydev, phandle_args.node, |
| 499 | KSZ9131RN_RX_DATA_PAD_SKEW, 4, |
| 500 | rx_data_skews, 4); |
| 501 | if (ret < 0) |
| 502 | return ret; |
| 503 | |
| 504 | return ksz9131_of_load_skew_values(phydev, phandle_args.node, |
| 505 | KSZ9131RN_TX_DATA_PAD_SKEW, 4, |
| 506 | tx_data_skews, 4); |
| 507 | } |
| 508 | |
Claudiu Beznea | 840a6b0 | 2020-12-03 11:18:30 +0200 | [diff] [blame] | 509 | static int ksz9131_config_rgmii_delay(struct phy_device *phydev) |
| 510 | { |
| 511 | struct phy_driver *drv = phydev->drv; |
| 512 | u16 rxcdll_val, txcdll_val, val; |
| 513 | int ret; |
| 514 | |
| 515 | switch (phydev->interface) { |
| 516 | case PHY_INTERFACE_MODE_RGMII: |
| 517 | rxcdll_val = KSZ9131RN_DLL_DISABLE_DELAY; |
| 518 | txcdll_val = KSZ9131RN_DLL_DISABLE_DELAY; |
| 519 | break; |
| 520 | case PHY_INTERFACE_MODE_RGMII_ID: |
| 521 | rxcdll_val = KSZ9131RN_DLL_ENABLE_DELAY; |
| 522 | txcdll_val = KSZ9131RN_DLL_ENABLE_DELAY; |
| 523 | break; |
| 524 | case PHY_INTERFACE_MODE_RGMII_RXID: |
| 525 | rxcdll_val = KSZ9131RN_DLL_ENABLE_DELAY; |
| 526 | txcdll_val = KSZ9131RN_DLL_DISABLE_DELAY; |
| 527 | break; |
| 528 | case PHY_INTERFACE_MODE_RGMII_TXID: |
| 529 | rxcdll_val = KSZ9131RN_DLL_DISABLE_DELAY; |
| 530 | txcdll_val = KSZ9131RN_DLL_ENABLE_DELAY; |
| 531 | break; |
| 532 | default: |
| 533 | return 0; |
| 534 | } |
| 535 | |
| 536 | val = drv->readext(phydev, 0, KSZ9131RN_MMD_COMMON_CTRL_REG, |
| 537 | KSZ9131RN_RXC_DLL_CTRL); |
| 538 | val &= ~KSZ9131RN_DLL_CTRL_BYPASS; |
| 539 | val |= rxcdll_val; |
| 540 | ret = drv->writeext(phydev, 0, KSZ9131RN_MMD_COMMON_CTRL_REG, |
| 541 | KSZ9131RN_RXC_DLL_CTRL, val); |
| 542 | if (ret) |
| 543 | return ret; |
| 544 | |
| 545 | val = drv->readext(phydev, 0, KSZ9131RN_MMD_COMMON_CTRL_REG, |
| 546 | KSZ9131RN_TXC_DLL_CTRL); |
| 547 | |
| 548 | val &= ~KSZ9131RN_DLL_CTRL_BYPASS; |
| 549 | val |= txcdll_val; |
| 550 | ret = drv->writeext(phydev, 0, KSZ9131RN_MMD_COMMON_CTRL_REG, |
| 551 | KSZ9131RN_TXC_DLL_CTRL, val); |
| 552 | |
| 553 | return ret; |
| 554 | } |
| 555 | |
Paul Barker | ef6bef6 | 2025-02-28 12:47:53 +0000 | [diff] [blame] | 556 | /* Silicon Errata DS80000693B |
| 557 | * |
| 558 | * When LEDs are configured in Individual Mode, LED1 is ON in a no-link |
| 559 | * condition. Workaround is to set register 0x1e, bit 9, this way LED1 behaves |
| 560 | * according to the datasheet (off if there is no link). |
| 561 | */ |
| 562 | static int ksz9131_led_errata(struct phy_device *phydev) |
| 563 | { |
| 564 | int reg; |
| 565 | |
| 566 | reg = phy_read_mmd(phydev, KSZ9131RN_MMD_COMMON_CTRL_REG, |
| 567 | KSZ9131RN_COMMON_CTRL); |
| 568 | if (reg < 0) |
| 569 | return reg; |
| 570 | |
| 571 | if (!(reg & KSZ9131RN_COMMON_CTRL_INDIVIDUAL_LED_MODE)) |
| 572 | return 0; |
| 573 | |
| 574 | return phy_set_bits(phydev, MDIO_DEVAD_NONE, KSZ9131RN_LED_ERRATA_REG, |
| 575 | KSZ9131RN_LED_ERRATA_BIT); |
| 576 | } |
| 577 | |
Philippe Schenker | 3060ecc | 2020-03-11 11:59:23 +0100 | [diff] [blame] | 578 | static int ksz9131_config(struct phy_device *phydev) |
| 579 | { |
Claudiu Beznea | 840a6b0 | 2020-12-03 11:18:30 +0200 | [diff] [blame] | 580 | int ret; |
| 581 | |
| 582 | if (phy_interface_is_rgmii(phydev)) { |
| 583 | ret = ksz9131_config_rgmii_delay(phydev); |
| 584 | if (ret) |
| 585 | return ret; |
| 586 | } |
Philippe Schenker | 3060ecc | 2020-03-11 11:59:23 +0100 | [diff] [blame] | 587 | |
Paul Barker | 59beaf3 | 2025-02-28 12:47:54 +0000 | [diff] [blame^] | 588 | ret = ksz9131_of_load_all_skew_values(phydev); |
| 589 | if (ret < 0) |
| 590 | return ret; |
| 591 | |
Paul Barker | ef6bef6 | 2025-02-28 12:47:53 +0000 | [diff] [blame] | 592 | ret = ksz9131_led_errata(phydev); |
| 593 | if (ret < 0) |
| 594 | return ret; |
| 595 | |
Philippe Schenker | 3060ecc | 2020-03-11 11:59:23 +0100 | [diff] [blame] | 596 | /* add an option to disable the gigabit feature of this PHY */ |
| 597 | if (env_get("disable_giga")) { |
| 598 | unsigned features; |
| 599 | unsigned bmcr; |
| 600 | |
| 601 | /* disable speed 1000 in features supported by the PHY */ |
| 602 | features = phydev->drv->features; |
| 603 | features &= ~(SUPPORTED_1000baseT_Half | |
| 604 | SUPPORTED_1000baseT_Full); |
| 605 | phydev->advertising = phydev->supported = features; |
| 606 | |
| 607 | /* disable speed 1000 in Basic Control Register */ |
| 608 | bmcr = phy_read(phydev, MDIO_DEVAD_NONE, MII_BMCR); |
| 609 | bmcr &= ~(1 << 6); |
| 610 | phy_write(phydev, MDIO_DEVAD_NONE, MII_BMCR, bmcr); |
| 611 | |
| 612 | /* disable speed 1000 in 1000Base-T Control Register */ |
| 613 | phy_write(phydev, MDIO_DEVAD_NONE, MII_CTRL1000, 0); |
| 614 | |
| 615 | /* start autoneg */ |
| 616 | genphy_config_aneg(phydev); |
| 617 | genphy_restart_aneg(phydev); |
| 618 | |
| 619 | return 0; |
| 620 | } |
| 621 | |
| 622 | return genphy_config(phydev); |
| 623 | } |
| 624 | |
Marek Vasut | ce250e9 | 2023-03-19 18:02:56 +0100 | [diff] [blame] | 625 | U_BOOT_PHY_DRIVER(ksz9131) = { |
Claudiu Beznea | 3f1606f | 2020-12-03 11:18:31 +0200 | [diff] [blame] | 626 | .name = "Micrel ksz9131", |
Philippe Schenker | 3060ecc | 2020-03-11 11:59:23 +0100 | [diff] [blame] | 627 | .uid = PHY_ID_KSZ9131, |
| 628 | .mask = MII_KSZ9x31_SILICON_REV_MASK, |
| 629 | .features = PHY_GBIT_FEATURES, |
| 630 | .config = &ksz9131_config, |
| 631 | .startup = &ksz90xx_startup, |
| 632 | .shutdown = &genphy_shutdown, |
| 633 | .writeext = &ksz9031_phy_extwrite, |
| 634 | .readext = &ksz9031_phy_extread, |
| 635 | }; |
| 636 | |
| 637 | int ksz9xx1_phy_get_id(struct phy_device *phydev) |
| 638 | { |
| 639 | unsigned int phyid; |
| 640 | |
| 641 | get_phy_id(phydev->bus, phydev->addr, MDIO_DEVAD_NONE, &phyid); |
| 642 | |
| 643 | return phyid; |
| 644 | } |