| xj | b04a402 | 2021-11-25 15:01:52 +0800 | [diff] [blame] | 1 | /* | 
|  | 2 | *	drivers/net/phy/broadcom.c | 
|  | 3 | * | 
|  | 4 | *	Broadcom BCM5411, BCM5421 and BCM5461 Gigabit Ethernet | 
|  | 5 | *	transceivers. | 
|  | 6 | * | 
|  | 7 | *	Copyright (c) 2006  Maciej W. Rozycki | 
|  | 8 | * | 
|  | 9 | *	Inspired by code written by Amy Fong. | 
|  | 10 | * | 
|  | 11 | *	This program is free software; you can redistribute it and/or | 
|  | 12 | *	modify it under the terms of the GNU General Public License | 
|  | 13 | *	as published by the Free Software Foundation; either version | 
|  | 14 | *	2 of the License, or (at your option) any later version. | 
|  | 15 | */ | 
|  | 16 |  | 
|  | 17 | #include "bcm-phy-lib.h" | 
|  | 18 | #include <linux/module.h> | 
|  | 19 | #include <linux/phy.h> | 
|  | 20 | #include <linux/brcmphy.h> | 
|  | 21 | #include <linux/of.h> | 
|  | 22 |  | 
|  | 23 | #define BRCM_PHY_MODEL(phydev) \ | 
|  | 24 | ((phydev)->drv->phy_id & (phydev)->drv->phy_id_mask) | 
|  | 25 |  | 
|  | 26 | #define BRCM_PHY_REV(phydev) \ | 
|  | 27 | ((phydev)->drv->phy_id & ~((phydev)->drv->phy_id_mask)) | 
|  | 28 |  | 
|  | 29 | MODULE_DESCRIPTION("Broadcom PHY driver"); | 
|  | 30 | MODULE_AUTHOR("Maciej W. Rozycki"); | 
|  | 31 | MODULE_LICENSE("GPL"); | 
|  | 32 |  | 
|  | 33 | static int bcm54210e_config_init(struct phy_device *phydev) | 
|  | 34 | { | 
|  | 35 | int val; | 
|  | 36 |  | 
|  | 37 | val = bcm54xx_auxctl_read(phydev, MII_BCM54XX_AUXCTL_SHDWSEL_MISC); | 
|  | 38 | val &= ~MII_BCM54XX_AUXCTL_SHDWSEL_MISC_RGMII_SKEW_EN; | 
|  | 39 | val |= MII_BCM54XX_AUXCTL_MISC_WREN; | 
|  | 40 | bcm54xx_auxctl_write(phydev, MII_BCM54XX_AUXCTL_SHDWSEL_MISC, val); | 
|  | 41 |  | 
|  | 42 | val = bcm_phy_read_shadow(phydev, BCM54810_SHD_CLK_CTL); | 
|  | 43 | val &= ~BCM54810_SHD_CLK_CTL_GTXCLK_EN; | 
|  | 44 | bcm_phy_write_shadow(phydev, BCM54810_SHD_CLK_CTL, val); | 
|  | 45 |  | 
|  | 46 | if (phydev->dev_flags & PHY_BRCM_EN_MASTER_MODE) { | 
|  | 47 | val = phy_read(phydev, MII_CTRL1000); | 
|  | 48 | val |= CTL1000_AS_MASTER | CTL1000_ENABLE_MASTER; | 
|  | 49 | phy_write(phydev, MII_CTRL1000, val); | 
|  | 50 | } | 
|  | 51 |  | 
|  | 52 | return 0; | 
|  | 53 | } | 
|  | 54 |  | 
|  | 55 | static int bcm54612e_config_init(struct phy_device *phydev) | 
|  | 56 | { | 
|  | 57 | int reg; | 
|  | 58 |  | 
|  | 59 | /* Clear TX internal delay unless requested. */ | 
|  | 60 | if ((phydev->interface != PHY_INTERFACE_MODE_RGMII_ID) && | 
|  | 61 | (phydev->interface != PHY_INTERFACE_MODE_RGMII_TXID)) { | 
|  | 62 | /* Disable TXD to GTXCLK clock delay (default set) */ | 
|  | 63 | /* Bit 9 is the only field in shadow register 00011 */ | 
|  | 64 | bcm_phy_write_shadow(phydev, 0x03, 0); | 
|  | 65 | } | 
|  | 66 |  | 
|  | 67 | /* Clear RX internal delay unless requested. */ | 
|  | 68 | if ((phydev->interface != PHY_INTERFACE_MODE_RGMII_ID) && | 
|  | 69 | (phydev->interface != PHY_INTERFACE_MODE_RGMII_RXID)) { | 
|  | 70 | reg = bcm54xx_auxctl_read(phydev, | 
|  | 71 | MII_BCM54XX_AUXCTL_SHDWSEL_MISC); | 
|  | 72 | /* Disable RXD to RXC delay (default set) */ | 
|  | 73 | reg &= ~MII_BCM54XX_AUXCTL_SHDWSEL_MISC_RGMII_SKEW_EN; | 
|  | 74 | /* Clear shadow selector field */ | 
|  | 75 | reg &= ~MII_BCM54XX_AUXCTL_SHDWSEL_MASK; | 
|  | 76 | bcm54xx_auxctl_write(phydev, MII_BCM54XX_AUXCTL_SHDWSEL_MISC, | 
|  | 77 | MII_BCM54XX_AUXCTL_MISC_WREN | reg); | 
|  | 78 | } | 
|  | 79 |  | 
|  | 80 | /* Enable CLK125 MUX on LED4 if ref clock is enabled. */ | 
|  | 81 | if (!(phydev->dev_flags & PHY_BRCM_RX_REFCLK_UNUSED)) { | 
|  | 82 | int err; | 
|  | 83 |  | 
|  | 84 | reg = bcm_phy_read_exp(phydev, BCM54612E_EXP_SPARE0); | 
|  | 85 | err = bcm_phy_write_exp(phydev, BCM54612E_EXP_SPARE0, | 
|  | 86 | BCM54612E_LED4_CLK125OUT_EN | reg); | 
|  | 87 |  | 
|  | 88 | if (err < 0) | 
|  | 89 | return err; | 
|  | 90 | } | 
|  | 91 |  | 
|  | 92 | return 0; | 
|  | 93 | } | 
|  | 94 |  | 
|  | 95 | static int bcm5481x_config(struct phy_device *phydev) | 
|  | 96 | { | 
|  | 97 | int rc, val; | 
|  | 98 |  | 
|  | 99 | /* handling PHY's internal RX clock delay */ | 
|  | 100 | val = bcm54xx_auxctl_read(phydev, MII_BCM54XX_AUXCTL_SHDWSEL_MISC); | 
|  | 101 | val |= MII_BCM54XX_AUXCTL_MISC_WREN; | 
|  | 102 | if (phydev->interface == PHY_INTERFACE_MODE_RGMII || | 
|  | 103 | phydev->interface == PHY_INTERFACE_MODE_RGMII_TXID) { | 
|  | 104 | /* Disable RGMII RXC-RXD skew */ | 
|  | 105 | val &= ~MII_BCM54XX_AUXCTL_SHDWSEL_MISC_RGMII_SKEW_EN; | 
|  | 106 | } | 
|  | 107 | if (phydev->interface == PHY_INTERFACE_MODE_RGMII_ID || | 
|  | 108 | phydev->interface == PHY_INTERFACE_MODE_RGMII_RXID) { | 
|  | 109 | /* Enable RGMII RXC-RXD skew */ | 
|  | 110 | val |= MII_BCM54XX_AUXCTL_SHDWSEL_MISC_RGMII_SKEW_EN; | 
|  | 111 | } | 
|  | 112 | rc = bcm54xx_auxctl_write(phydev, MII_BCM54XX_AUXCTL_SHDWSEL_MISC, | 
|  | 113 | val); | 
|  | 114 | if (rc < 0) | 
|  | 115 | return rc; | 
|  | 116 |  | 
|  | 117 | /* handling PHY's internal TX clock delay */ | 
|  | 118 | val = bcm_phy_read_shadow(phydev, BCM54810_SHD_CLK_CTL); | 
|  | 119 | if (phydev->interface == PHY_INTERFACE_MODE_RGMII || | 
|  | 120 | phydev->interface == PHY_INTERFACE_MODE_RGMII_RXID) { | 
|  | 121 | /* Disable internal TX clock delay */ | 
|  | 122 | val &= ~BCM54810_SHD_CLK_CTL_GTXCLK_EN; | 
|  | 123 | } | 
|  | 124 | if (phydev->interface == PHY_INTERFACE_MODE_RGMII_ID || | 
|  | 125 | phydev->interface == PHY_INTERFACE_MODE_RGMII_TXID) { | 
|  | 126 | /* Enable internal TX clock delay */ | 
|  | 127 | val |= BCM54810_SHD_CLK_CTL_GTXCLK_EN; | 
|  | 128 | } | 
|  | 129 | rc = bcm_phy_write_shadow(phydev, BCM54810_SHD_CLK_CTL, val); | 
|  | 130 | if (rc < 0) | 
|  | 131 | return rc; | 
|  | 132 |  | 
|  | 133 | return 0; | 
|  | 134 | } | 
|  | 135 |  | 
|  | 136 | /* Needs SMDSP clock enabled via bcm54xx_phydsp_config() */ | 
|  | 137 | static int bcm50610_a0_workaround(struct phy_device *phydev) | 
|  | 138 | { | 
|  | 139 | int err; | 
|  | 140 |  | 
|  | 141 | err = bcm_phy_write_exp(phydev, MII_BCM54XX_EXP_AADJ1CH0, | 
|  | 142 | MII_BCM54XX_EXP_AADJ1CH0_SWP_ABCD_OEN | | 
|  | 143 | MII_BCM54XX_EXP_AADJ1CH0_SWSEL_THPF); | 
|  | 144 | if (err < 0) | 
|  | 145 | return err; | 
|  | 146 |  | 
|  | 147 | err = bcm_phy_write_exp(phydev, MII_BCM54XX_EXP_AADJ1CH3, | 
|  | 148 | MII_BCM54XX_EXP_AADJ1CH3_ADCCKADJ); | 
|  | 149 | if (err < 0) | 
|  | 150 | return err; | 
|  | 151 |  | 
|  | 152 | err = bcm_phy_write_exp(phydev, MII_BCM54XX_EXP_EXP75, | 
|  | 153 | MII_BCM54XX_EXP_EXP75_VDACCTRL); | 
|  | 154 | if (err < 0) | 
|  | 155 | return err; | 
|  | 156 |  | 
|  | 157 | err = bcm_phy_write_exp(phydev, MII_BCM54XX_EXP_EXP96, | 
|  | 158 | MII_BCM54XX_EXP_EXP96_MYST); | 
|  | 159 | if (err < 0) | 
|  | 160 | return err; | 
|  | 161 |  | 
|  | 162 | err = bcm_phy_write_exp(phydev, MII_BCM54XX_EXP_EXP97, | 
|  | 163 | MII_BCM54XX_EXP_EXP97_MYST); | 
|  | 164 |  | 
|  | 165 | return err; | 
|  | 166 | } | 
|  | 167 |  | 
|  | 168 | static int bcm54xx_phydsp_config(struct phy_device *phydev) | 
|  | 169 | { | 
|  | 170 | int err, err2; | 
|  | 171 |  | 
|  | 172 | /* Enable the SMDSP clock */ | 
|  | 173 | err = bcm54xx_auxctl_write(phydev, | 
|  | 174 | MII_BCM54XX_AUXCTL_SHDWSEL_AUXCTL, | 
|  | 175 | MII_BCM54XX_AUXCTL_ACTL_SMDSP_ENA | | 
|  | 176 | MII_BCM54XX_AUXCTL_ACTL_TX_6DB); | 
|  | 177 | if (err < 0) | 
|  | 178 | return err; | 
|  | 179 |  | 
|  | 180 | if (BRCM_PHY_MODEL(phydev) == PHY_ID_BCM50610 || | 
|  | 181 | BRCM_PHY_MODEL(phydev) == PHY_ID_BCM50610M) { | 
|  | 182 | /* Clear bit 9 to fix a phy interop issue. */ | 
|  | 183 | err = bcm_phy_write_exp(phydev, MII_BCM54XX_EXP_EXP08, | 
|  | 184 | MII_BCM54XX_EXP_EXP08_RJCT_2MHZ); | 
|  | 185 | if (err < 0) | 
|  | 186 | goto error; | 
|  | 187 |  | 
|  | 188 | if (phydev->drv->phy_id == PHY_ID_BCM50610) { | 
|  | 189 | err = bcm50610_a0_workaround(phydev); | 
|  | 190 | if (err < 0) | 
|  | 191 | goto error; | 
|  | 192 | } | 
|  | 193 | } | 
|  | 194 |  | 
|  | 195 | if (BRCM_PHY_MODEL(phydev) == PHY_ID_BCM57780) { | 
|  | 196 | int val; | 
|  | 197 |  | 
|  | 198 | val = bcm_phy_read_exp(phydev, MII_BCM54XX_EXP_EXP75); | 
|  | 199 | if (val < 0) | 
|  | 200 | goto error; | 
|  | 201 |  | 
|  | 202 | val |= MII_BCM54XX_EXP_EXP75_CM_OSC; | 
|  | 203 | err = bcm_phy_write_exp(phydev, MII_BCM54XX_EXP_EXP75, val); | 
|  | 204 | } | 
|  | 205 |  | 
|  | 206 | error: | 
|  | 207 | /* Disable the SMDSP clock */ | 
|  | 208 | err2 = bcm54xx_auxctl_write(phydev, | 
|  | 209 | MII_BCM54XX_AUXCTL_SHDWSEL_AUXCTL, | 
|  | 210 | MII_BCM54XX_AUXCTL_ACTL_TX_6DB); | 
|  | 211 |  | 
|  | 212 | /* Return the first error reported. */ | 
|  | 213 | return err ? err : err2; | 
|  | 214 | } | 
|  | 215 |  | 
|  | 216 | static void bcm54xx_adjust_rxrefclk(struct phy_device *phydev) | 
|  | 217 | { | 
|  | 218 | u32 orig; | 
|  | 219 | int val; | 
|  | 220 | bool clk125en = true; | 
|  | 221 |  | 
|  | 222 | /* Abort if we are using an untested phy. */ | 
|  | 223 | if (BRCM_PHY_MODEL(phydev) != PHY_ID_BCM57780 && | 
|  | 224 | BRCM_PHY_MODEL(phydev) != PHY_ID_BCM50610 && | 
|  | 225 | BRCM_PHY_MODEL(phydev) != PHY_ID_BCM50610M) | 
|  | 226 | return; | 
|  | 227 |  | 
|  | 228 | val = bcm_phy_read_shadow(phydev, BCM54XX_SHD_SCR3); | 
|  | 229 | if (val < 0) | 
|  | 230 | return; | 
|  | 231 |  | 
|  | 232 | orig = val; | 
|  | 233 |  | 
|  | 234 | if ((BRCM_PHY_MODEL(phydev) == PHY_ID_BCM50610 || | 
|  | 235 | BRCM_PHY_MODEL(phydev) == PHY_ID_BCM50610M) && | 
|  | 236 | BRCM_PHY_REV(phydev) >= 0x3) { | 
|  | 237 | /* | 
|  | 238 | * Here, bit 0 _disables_ CLK125 when set. | 
|  | 239 | * This bit is set by default. | 
|  | 240 | */ | 
|  | 241 | clk125en = false; | 
|  | 242 | } else { | 
|  | 243 | if (phydev->dev_flags & PHY_BRCM_RX_REFCLK_UNUSED) { | 
|  | 244 | /* Here, bit 0 _enables_ CLK125 when set */ | 
|  | 245 | val &= ~BCM54XX_SHD_SCR3_DEF_CLK125; | 
|  | 246 | clk125en = false; | 
|  | 247 | } | 
|  | 248 | } | 
|  | 249 |  | 
|  | 250 | if (!clk125en || (phydev->dev_flags & PHY_BRCM_AUTO_PWRDWN_ENABLE)) | 
|  | 251 | val &= ~BCM54XX_SHD_SCR3_DLLAPD_DIS; | 
|  | 252 | else | 
|  | 253 | val |= BCM54XX_SHD_SCR3_DLLAPD_DIS; | 
|  | 254 |  | 
|  | 255 | if (phydev->dev_flags & PHY_BRCM_DIS_TXCRXC_NOENRGY) | 
|  | 256 | val |= BCM54XX_SHD_SCR3_TRDDAPD; | 
|  | 257 |  | 
|  | 258 | if (orig != val) | 
|  | 259 | bcm_phy_write_shadow(phydev, BCM54XX_SHD_SCR3, val); | 
|  | 260 |  | 
|  | 261 | val = bcm_phy_read_shadow(phydev, BCM54XX_SHD_APD); | 
|  | 262 | if (val < 0) | 
|  | 263 | return; | 
|  | 264 |  | 
|  | 265 | orig = val; | 
|  | 266 |  | 
|  | 267 | if (!clk125en || (phydev->dev_flags & PHY_BRCM_AUTO_PWRDWN_ENABLE)) | 
|  | 268 | val |= BCM54XX_SHD_APD_EN; | 
|  | 269 | else | 
|  | 270 | val &= ~BCM54XX_SHD_APD_EN; | 
|  | 271 |  | 
|  | 272 | if (orig != val) | 
|  | 273 | bcm_phy_write_shadow(phydev, BCM54XX_SHD_APD, val); | 
|  | 274 | } | 
|  | 275 |  | 
|  | 276 | static int bcm54xx_config_init(struct phy_device *phydev) | 
|  | 277 | { | 
|  | 278 | int reg, err, val; | 
|  | 279 |  | 
|  | 280 | reg = phy_read(phydev, MII_BCM54XX_ECR); | 
|  | 281 | if (reg < 0) | 
|  | 282 | return reg; | 
|  | 283 |  | 
|  | 284 | /* Mask interrupts globally.  */ | 
|  | 285 | reg |= MII_BCM54XX_ECR_IM; | 
|  | 286 | err = phy_write(phydev, MII_BCM54XX_ECR, reg); | 
|  | 287 | if (err < 0) | 
|  | 288 | return err; | 
|  | 289 |  | 
|  | 290 | /* Unmask events we are interested in.  */ | 
|  | 291 | reg = ~(MII_BCM54XX_INT_DUPLEX | | 
|  | 292 | MII_BCM54XX_INT_SPEED | | 
|  | 293 | MII_BCM54XX_INT_LINK); | 
|  | 294 | err = phy_write(phydev, MII_BCM54XX_IMR, reg); | 
|  | 295 | if (err < 0) | 
|  | 296 | return err; | 
|  | 297 |  | 
|  | 298 | if ((BRCM_PHY_MODEL(phydev) == PHY_ID_BCM50610 || | 
|  | 299 | BRCM_PHY_MODEL(phydev) == PHY_ID_BCM50610M) && | 
|  | 300 | (phydev->dev_flags & PHY_BRCM_CLEAR_RGMII_MODE)) | 
|  | 301 | bcm_phy_write_shadow(phydev, BCM54XX_SHD_RGMII_MODE, 0); | 
|  | 302 |  | 
|  | 303 | if ((phydev->dev_flags & PHY_BRCM_RX_REFCLK_UNUSED) || | 
|  | 304 | (phydev->dev_flags & PHY_BRCM_DIS_TXCRXC_NOENRGY) || | 
|  | 305 | (phydev->dev_flags & PHY_BRCM_AUTO_PWRDWN_ENABLE)) | 
|  | 306 | bcm54xx_adjust_rxrefclk(phydev); | 
|  | 307 |  | 
|  | 308 | if (BRCM_PHY_MODEL(phydev) == PHY_ID_BCM54210E) { | 
|  | 309 | err = bcm54210e_config_init(phydev); | 
|  | 310 | if (err) | 
|  | 311 | return err; | 
|  | 312 | } else if (BRCM_PHY_MODEL(phydev) == PHY_ID_BCM54612E) { | 
|  | 313 | err = bcm54612e_config_init(phydev); | 
|  | 314 | if (err) | 
|  | 315 | return err; | 
|  | 316 | } else if (BRCM_PHY_MODEL(phydev) == PHY_ID_BCM54810) { | 
|  | 317 | /* For BCM54810, we need to disable BroadR-Reach function */ | 
|  | 318 | val = bcm_phy_read_exp(phydev, | 
|  | 319 | BCM54810_EXP_BROADREACH_LRE_MISC_CTL); | 
|  | 320 | val &= ~BCM54810_EXP_BROADREACH_LRE_MISC_CTL_EN; | 
|  | 321 | err = bcm_phy_write_exp(phydev, | 
|  | 322 | BCM54810_EXP_BROADREACH_LRE_MISC_CTL, | 
|  | 323 | val); | 
|  | 324 | if (err < 0) | 
|  | 325 | return err; | 
|  | 326 | } | 
|  | 327 |  | 
|  | 328 | bcm54xx_phydsp_config(phydev); | 
|  | 329 |  | 
|  | 330 | return 0; | 
|  | 331 | } | 
|  | 332 |  | 
|  | 333 | static int bcm5482_config_init(struct phy_device *phydev) | 
|  | 334 | { | 
|  | 335 | int err, reg; | 
|  | 336 |  | 
|  | 337 | err = bcm54xx_config_init(phydev); | 
|  | 338 |  | 
|  | 339 | if (phydev->dev_flags & PHY_BCM_FLAGS_MODE_1000BX) { | 
|  | 340 | /* | 
|  | 341 | * Enable secondary SerDes and its use as an LED source | 
|  | 342 | */ | 
|  | 343 | reg = bcm_phy_read_shadow(phydev, BCM5482_SHD_SSD); | 
|  | 344 | bcm_phy_write_shadow(phydev, BCM5482_SHD_SSD, | 
|  | 345 | reg | | 
|  | 346 | BCM5482_SHD_SSD_LEDM | | 
|  | 347 | BCM5482_SHD_SSD_EN); | 
|  | 348 |  | 
|  | 349 | /* | 
|  | 350 | * Enable SGMII slave mode and auto-detection | 
|  | 351 | */ | 
|  | 352 | reg = BCM5482_SSD_SGMII_SLAVE | MII_BCM54XX_EXP_SEL_SSD; | 
|  | 353 | err = bcm_phy_read_exp(phydev, reg); | 
|  | 354 | if (err < 0) | 
|  | 355 | return err; | 
|  | 356 | err = bcm_phy_write_exp(phydev, reg, err | | 
|  | 357 | BCM5482_SSD_SGMII_SLAVE_EN | | 
|  | 358 | BCM5482_SSD_SGMII_SLAVE_AD); | 
|  | 359 | if (err < 0) | 
|  | 360 | return err; | 
|  | 361 |  | 
|  | 362 | /* | 
|  | 363 | * Disable secondary SerDes powerdown | 
|  | 364 | */ | 
|  | 365 | reg = BCM5482_SSD_1000BX_CTL | MII_BCM54XX_EXP_SEL_SSD; | 
|  | 366 | err = bcm_phy_read_exp(phydev, reg); | 
|  | 367 | if (err < 0) | 
|  | 368 | return err; | 
|  | 369 | err = bcm_phy_write_exp(phydev, reg, | 
|  | 370 | err & ~BCM5482_SSD_1000BX_CTL_PWRDOWN); | 
|  | 371 | if (err < 0) | 
|  | 372 | return err; | 
|  | 373 |  | 
|  | 374 | /* | 
|  | 375 | * Select 1000BASE-X register set (primary SerDes) | 
|  | 376 | */ | 
|  | 377 | reg = bcm_phy_read_shadow(phydev, BCM5482_SHD_MODE); | 
|  | 378 | bcm_phy_write_shadow(phydev, BCM5482_SHD_MODE, | 
|  | 379 | reg | BCM5482_SHD_MODE_1000BX); | 
|  | 380 |  | 
|  | 381 | /* | 
|  | 382 | * LED1=ACTIVITYLED, LED3=LINKSPD[2] | 
|  | 383 | * (Use LED1 as secondary SerDes ACTIVITY LED) | 
|  | 384 | */ | 
|  | 385 | bcm_phy_write_shadow(phydev, BCM5482_SHD_LEDS1, | 
|  | 386 | BCM5482_SHD_LEDS1_LED1(BCM_LED_SRC_ACTIVITYLED) | | 
|  | 387 | BCM5482_SHD_LEDS1_LED3(BCM_LED_SRC_LINKSPD2)); | 
|  | 388 |  | 
|  | 389 | /* | 
|  | 390 | * Auto-negotiation doesn't seem to work quite right | 
|  | 391 | * in this mode, so we disable it and force it to the | 
|  | 392 | * right speed/duplex setting.  Only 'link status' | 
|  | 393 | * is important. | 
|  | 394 | */ | 
|  | 395 | phydev->autoneg = AUTONEG_DISABLE; | 
|  | 396 | phydev->speed = SPEED_1000; | 
|  | 397 | phydev->duplex = DUPLEX_FULL; | 
|  | 398 | } | 
|  | 399 |  | 
|  | 400 | return err; | 
|  | 401 | } | 
|  | 402 |  | 
|  | 403 | static int bcm5482_read_status(struct phy_device *phydev) | 
|  | 404 | { | 
|  | 405 | int err; | 
|  | 406 |  | 
|  | 407 | err = genphy_read_status(phydev); | 
|  | 408 |  | 
|  | 409 | if (phydev->dev_flags & PHY_BCM_FLAGS_MODE_1000BX) { | 
|  | 410 | /* | 
|  | 411 | * Only link status matters for 1000Base-X mode, so force | 
|  | 412 | * 1000 Mbit/s full-duplex status | 
|  | 413 | */ | 
|  | 414 | if (phydev->link) { | 
|  | 415 | phydev->speed = SPEED_1000; | 
|  | 416 | phydev->duplex = DUPLEX_FULL; | 
|  | 417 | } | 
|  | 418 | } | 
|  | 419 |  | 
|  | 420 | return err; | 
|  | 421 | } | 
|  | 422 |  | 
|  | 423 | static int bcm5481_config_aneg(struct phy_device *phydev) | 
|  | 424 | { | 
|  | 425 | struct device_node *np = phydev->mdio.dev.of_node; | 
|  | 426 | int ret; | 
|  | 427 |  | 
|  | 428 | /* Aneg firsly. */ | 
|  | 429 | ret = genphy_config_aneg(phydev); | 
|  | 430 |  | 
|  | 431 | /* Then we can set up the delay. */ | 
|  | 432 | bcm5481x_config(phydev); | 
|  | 433 |  | 
|  | 434 | if (of_property_read_bool(np, "enet-phy-lane-swap")) { | 
|  | 435 | /* Lane Swap - Undocumented register...magic! */ | 
|  | 436 | ret = bcm_phy_write_exp(phydev, MII_BCM54XX_EXP_SEL_ER + 0x9, | 
|  | 437 | 0x11B); | 
|  | 438 | if (ret < 0) | 
|  | 439 | return ret; | 
|  | 440 | } | 
|  | 441 |  | 
|  | 442 | return ret; | 
|  | 443 | } | 
|  | 444 |  | 
|  | 445 | static int brcm_phy_setbits(struct phy_device *phydev, int reg, int set) | 
|  | 446 | { | 
|  | 447 | int val; | 
|  | 448 |  | 
|  | 449 | val = phy_read(phydev, reg); | 
|  | 450 | if (val < 0) | 
|  | 451 | return val; | 
|  | 452 |  | 
|  | 453 | return phy_write(phydev, reg, val | set); | 
|  | 454 | } | 
|  | 455 |  | 
|  | 456 | static int brcm_fet_config_init(struct phy_device *phydev) | 
|  | 457 | { | 
|  | 458 | int reg, err, err2, brcmtest; | 
|  | 459 |  | 
|  | 460 | /* Reset the PHY to bring it to a known state. */ | 
|  | 461 | err = phy_write(phydev, MII_BMCR, BMCR_RESET); | 
|  | 462 | if (err < 0) | 
|  | 463 | return err; | 
|  | 464 |  | 
|  | 465 | reg = phy_read(phydev, MII_BRCM_FET_INTREG); | 
|  | 466 | if (reg < 0) | 
|  | 467 | return reg; | 
|  | 468 |  | 
|  | 469 | /* Unmask events we are interested in and mask interrupts globally. */ | 
|  | 470 | reg = MII_BRCM_FET_IR_DUPLEX_EN | | 
|  | 471 | MII_BRCM_FET_IR_SPEED_EN | | 
|  | 472 | MII_BRCM_FET_IR_LINK_EN | | 
|  | 473 | MII_BRCM_FET_IR_ENABLE | | 
|  | 474 | MII_BRCM_FET_IR_MASK; | 
|  | 475 |  | 
|  | 476 | err = phy_write(phydev, MII_BRCM_FET_INTREG, reg); | 
|  | 477 | if (err < 0) | 
|  | 478 | return err; | 
|  | 479 |  | 
|  | 480 | /* Enable shadow register access */ | 
|  | 481 | brcmtest = phy_read(phydev, MII_BRCM_FET_BRCMTEST); | 
|  | 482 | if (brcmtest < 0) | 
|  | 483 | return brcmtest; | 
|  | 484 |  | 
|  | 485 | reg = brcmtest | MII_BRCM_FET_BT_SRE; | 
|  | 486 |  | 
|  | 487 | err = phy_write(phydev, MII_BRCM_FET_BRCMTEST, reg); | 
|  | 488 | if (err < 0) | 
|  | 489 | return err; | 
|  | 490 |  | 
|  | 491 | /* Set the LED mode */ | 
|  | 492 | reg = phy_read(phydev, MII_BRCM_FET_SHDW_AUXMODE4); | 
|  | 493 | if (reg < 0) { | 
|  | 494 | err = reg; | 
|  | 495 | goto done; | 
|  | 496 | } | 
|  | 497 |  | 
|  | 498 | reg &= ~MII_BRCM_FET_SHDW_AM4_LED_MASK; | 
|  | 499 | reg |= MII_BRCM_FET_SHDW_AM4_LED_MODE1; | 
|  | 500 |  | 
|  | 501 | err = phy_write(phydev, MII_BRCM_FET_SHDW_AUXMODE4, reg); | 
|  | 502 | if (err < 0) | 
|  | 503 | goto done; | 
|  | 504 |  | 
|  | 505 | /* Enable auto MDIX */ | 
|  | 506 | err = brcm_phy_setbits(phydev, MII_BRCM_FET_SHDW_MISCCTRL, | 
|  | 507 | MII_BRCM_FET_SHDW_MC_FAME); | 
|  | 508 | if (err < 0) | 
|  | 509 | goto done; | 
|  | 510 |  | 
|  | 511 | if (phydev->dev_flags & PHY_BRCM_AUTO_PWRDWN_ENABLE) { | 
|  | 512 | /* Enable auto power down */ | 
|  | 513 | err = brcm_phy_setbits(phydev, MII_BRCM_FET_SHDW_AUXSTAT2, | 
|  | 514 | MII_BRCM_FET_SHDW_AS2_APDE); | 
|  | 515 | } | 
|  | 516 |  | 
|  | 517 | done: | 
|  | 518 | /* Disable shadow register access */ | 
|  | 519 | err2 = phy_write(phydev, MII_BRCM_FET_BRCMTEST, brcmtest); | 
|  | 520 | if (!err) | 
|  | 521 | err = err2; | 
|  | 522 |  | 
|  | 523 | return err; | 
|  | 524 | } | 
|  | 525 |  | 
|  | 526 | static int brcm_fet_ack_interrupt(struct phy_device *phydev) | 
|  | 527 | { | 
|  | 528 | int reg; | 
|  | 529 |  | 
|  | 530 | /* Clear pending interrupts.  */ | 
|  | 531 | reg = phy_read(phydev, MII_BRCM_FET_INTREG); | 
|  | 532 | if (reg < 0) | 
|  | 533 | return reg; | 
|  | 534 |  | 
|  | 535 | return 0; | 
|  | 536 | } | 
|  | 537 |  | 
|  | 538 | static int brcm_fet_config_intr(struct phy_device *phydev) | 
|  | 539 | { | 
|  | 540 | int reg, err; | 
|  | 541 |  | 
|  | 542 | reg = phy_read(phydev, MII_BRCM_FET_INTREG); | 
|  | 543 | if (reg < 0) | 
|  | 544 | return reg; | 
|  | 545 |  | 
|  | 546 | if (phydev->interrupts == PHY_INTERRUPT_ENABLED) | 
|  | 547 | reg &= ~MII_BRCM_FET_IR_MASK; | 
|  | 548 | else | 
|  | 549 | reg |= MII_BRCM_FET_IR_MASK; | 
|  | 550 |  | 
|  | 551 | err = phy_write(phydev, MII_BRCM_FET_INTREG, reg); | 
|  | 552 | return err; | 
|  | 553 | } | 
|  | 554 |  | 
|  | 555 | struct bcm53xx_phy_priv { | 
|  | 556 | u64	*stats; | 
|  | 557 | }; | 
|  | 558 |  | 
|  | 559 | static int bcm53xx_phy_probe(struct phy_device *phydev) | 
|  | 560 | { | 
|  | 561 | struct bcm53xx_phy_priv *priv; | 
|  | 562 |  | 
|  | 563 | priv = devm_kzalloc(&phydev->mdio.dev, sizeof(*priv), GFP_KERNEL); | 
|  | 564 | if (!priv) | 
|  | 565 | return -ENOMEM; | 
|  | 566 |  | 
|  | 567 | phydev->priv = priv; | 
|  | 568 |  | 
|  | 569 | priv->stats = devm_kcalloc(&phydev->mdio.dev, | 
|  | 570 | bcm_phy_get_sset_count(phydev), sizeof(u64), | 
|  | 571 | GFP_KERNEL); | 
|  | 572 | if (!priv->stats) | 
|  | 573 | return -ENOMEM; | 
|  | 574 |  | 
|  | 575 | return 0; | 
|  | 576 | } | 
|  | 577 |  | 
|  | 578 | static void bcm53xx_phy_get_stats(struct phy_device *phydev, | 
|  | 579 | struct ethtool_stats *stats, u64 *data) | 
|  | 580 | { | 
|  | 581 | struct bcm53xx_phy_priv *priv = phydev->priv; | 
|  | 582 |  | 
|  | 583 | bcm_phy_get_stats(phydev, priv->stats, stats, data); | 
|  | 584 | } | 
|  | 585 |  | 
|  | 586 | static struct phy_driver broadcom_drivers[] = { | 
|  | 587 | { | 
|  | 588 | .phy_id		= PHY_ID_BCM5411, | 
|  | 589 | .phy_id_mask	= 0xfffffff0, | 
|  | 590 | .name		= "Broadcom BCM5411", | 
|  | 591 | .features	= PHY_GBIT_FEATURES, | 
|  | 592 | .flags		= PHY_HAS_INTERRUPT, | 
|  | 593 | .config_init	= bcm54xx_config_init, | 
|  | 594 | .ack_interrupt	= bcm_phy_ack_intr, | 
|  | 595 | .config_intr	= bcm_phy_config_intr, | 
|  | 596 | }, { | 
|  | 597 | .phy_id		= PHY_ID_BCM5421, | 
|  | 598 | .phy_id_mask	= 0xfffffff0, | 
|  | 599 | .name		= "Broadcom BCM5421", | 
|  | 600 | .features	= PHY_GBIT_FEATURES, | 
|  | 601 | .flags		= PHY_HAS_INTERRUPT, | 
|  | 602 | .config_init	= bcm54xx_config_init, | 
|  | 603 | .ack_interrupt	= bcm_phy_ack_intr, | 
|  | 604 | .config_intr	= bcm_phy_config_intr, | 
|  | 605 | }, { | 
|  | 606 | .phy_id		= PHY_ID_BCM54210E, | 
|  | 607 | .phy_id_mask	= 0xfffffff0, | 
|  | 608 | .name		= "Broadcom BCM54210E", | 
|  | 609 | .features	= PHY_GBIT_FEATURES, | 
|  | 610 | .flags		= PHY_HAS_INTERRUPT, | 
|  | 611 | .config_init	= bcm54xx_config_init, | 
|  | 612 | .ack_interrupt	= bcm_phy_ack_intr, | 
|  | 613 | .config_intr	= bcm_phy_config_intr, | 
|  | 614 | }, { | 
|  | 615 | .phy_id		= PHY_ID_BCM5461, | 
|  | 616 | .phy_id_mask	= 0xfffffff0, | 
|  | 617 | .name		= "Broadcom BCM5461", | 
|  | 618 | .features	= PHY_GBIT_FEATURES, | 
|  | 619 | .flags		= PHY_HAS_INTERRUPT, | 
|  | 620 | .config_init	= bcm54xx_config_init, | 
|  | 621 | .ack_interrupt	= bcm_phy_ack_intr, | 
|  | 622 | .config_intr	= bcm_phy_config_intr, | 
|  | 623 | }, { | 
|  | 624 | .phy_id		= PHY_ID_BCM54612E, | 
|  | 625 | .phy_id_mask	= 0xfffffff0, | 
|  | 626 | .name		= "Broadcom BCM54612E", | 
|  | 627 | .features	= PHY_GBIT_FEATURES, | 
|  | 628 | .flags		= PHY_HAS_INTERRUPT, | 
|  | 629 | .config_init	= bcm54xx_config_init, | 
|  | 630 | .ack_interrupt	= bcm_phy_ack_intr, | 
|  | 631 | .config_intr	= bcm_phy_config_intr, | 
|  | 632 | }, { | 
|  | 633 | .phy_id		= PHY_ID_BCM54616S, | 
|  | 634 | .phy_id_mask	= 0xfffffff0, | 
|  | 635 | .name		= "Broadcom BCM54616S", | 
|  | 636 | .features	= PHY_GBIT_FEATURES, | 
|  | 637 | .flags		= PHY_HAS_INTERRUPT, | 
|  | 638 | .config_init	= bcm54xx_config_init, | 
|  | 639 | .ack_interrupt	= bcm_phy_ack_intr, | 
|  | 640 | .config_intr	= bcm_phy_config_intr, | 
|  | 641 | }, { | 
|  | 642 | .phy_id		= PHY_ID_BCM5464, | 
|  | 643 | .phy_id_mask	= 0xfffffff0, | 
|  | 644 | .name		= "Broadcom BCM5464", | 
|  | 645 | .features	= PHY_GBIT_FEATURES, | 
|  | 646 | .flags		= PHY_HAS_INTERRUPT, | 
|  | 647 | .config_init	= bcm54xx_config_init, | 
|  | 648 | .ack_interrupt	= bcm_phy_ack_intr, | 
|  | 649 | .config_intr	= bcm_phy_config_intr, | 
|  | 650 | }, { | 
|  | 651 | .phy_id		= PHY_ID_BCM5481, | 
|  | 652 | .phy_id_mask	= 0xfffffff0, | 
|  | 653 | .name		= "Broadcom BCM5481", | 
|  | 654 | .features	= PHY_GBIT_FEATURES, | 
|  | 655 | .flags		= PHY_HAS_INTERRUPT, | 
|  | 656 | .config_init	= bcm54xx_config_init, | 
|  | 657 | .config_aneg	= bcm5481_config_aneg, | 
|  | 658 | .ack_interrupt	= bcm_phy_ack_intr, | 
|  | 659 | .config_intr	= bcm_phy_config_intr, | 
|  | 660 | }, { | 
|  | 661 | .phy_id         = PHY_ID_BCM54810, | 
|  | 662 | .phy_id_mask    = 0xfffffff0, | 
|  | 663 | .name           = "Broadcom BCM54810", | 
|  | 664 | .features       = PHY_GBIT_FEATURES, | 
|  | 665 | .flags          = PHY_HAS_INTERRUPT, | 
|  | 666 | .config_init    = bcm54xx_config_init, | 
|  | 667 | .config_aneg    = bcm5481_config_aneg, | 
|  | 668 | .ack_interrupt  = bcm_phy_ack_intr, | 
|  | 669 | .config_intr    = bcm_phy_config_intr, | 
|  | 670 | }, { | 
|  | 671 | .phy_id		= PHY_ID_BCM5482, | 
|  | 672 | .phy_id_mask	= 0xfffffff0, | 
|  | 673 | .name		= "Broadcom BCM5482", | 
|  | 674 | .features	= PHY_GBIT_FEATURES, | 
|  | 675 | .flags		= PHY_HAS_INTERRUPT, | 
|  | 676 | .config_init	= bcm5482_config_init, | 
|  | 677 | .read_status	= bcm5482_read_status, | 
|  | 678 | .ack_interrupt	= bcm_phy_ack_intr, | 
|  | 679 | .config_intr	= bcm_phy_config_intr, | 
|  | 680 | }, { | 
|  | 681 | .phy_id		= PHY_ID_BCM50610, | 
|  | 682 | .phy_id_mask	= 0xfffffff0, | 
|  | 683 | .name		= "Broadcom BCM50610", | 
|  | 684 | .features	= PHY_GBIT_FEATURES, | 
|  | 685 | .flags		= PHY_HAS_INTERRUPT, | 
|  | 686 | .config_init	= bcm54xx_config_init, | 
|  | 687 | .ack_interrupt	= bcm_phy_ack_intr, | 
|  | 688 | .config_intr	= bcm_phy_config_intr, | 
|  | 689 | }, { | 
|  | 690 | .phy_id		= PHY_ID_BCM50610M, | 
|  | 691 | .phy_id_mask	= 0xfffffff0, | 
|  | 692 | .name		= "Broadcom BCM50610M", | 
|  | 693 | .features	= PHY_GBIT_FEATURES, | 
|  | 694 | .flags		= PHY_HAS_INTERRUPT, | 
|  | 695 | .config_init	= bcm54xx_config_init, | 
|  | 696 | .ack_interrupt	= bcm_phy_ack_intr, | 
|  | 697 | .config_intr	= bcm_phy_config_intr, | 
|  | 698 | }, { | 
|  | 699 | .phy_id		= PHY_ID_BCM57780, | 
|  | 700 | .phy_id_mask	= 0xfffffff0, | 
|  | 701 | .name		= "Broadcom BCM57780", | 
|  | 702 | .features	= PHY_GBIT_FEATURES, | 
|  | 703 | .flags		= PHY_HAS_INTERRUPT, | 
|  | 704 | .config_init	= bcm54xx_config_init, | 
|  | 705 | .ack_interrupt	= bcm_phy_ack_intr, | 
|  | 706 | .config_intr	= bcm_phy_config_intr, | 
|  | 707 | }, { | 
|  | 708 | .phy_id		= PHY_ID_BCMAC131, | 
|  | 709 | .phy_id_mask	= 0xfffffff0, | 
|  | 710 | .name		= "Broadcom BCMAC131", | 
|  | 711 | .features	= PHY_BASIC_FEATURES, | 
|  | 712 | .flags		= PHY_HAS_INTERRUPT, | 
|  | 713 | .config_init	= brcm_fet_config_init, | 
|  | 714 | .ack_interrupt	= brcm_fet_ack_interrupt, | 
|  | 715 | .config_intr	= brcm_fet_config_intr, | 
|  | 716 | }, { | 
|  | 717 | .phy_id		= PHY_ID_BCM5241, | 
|  | 718 | .phy_id_mask	= 0xfffffff0, | 
|  | 719 | .name		= "Broadcom BCM5241", | 
|  | 720 | .features	= PHY_BASIC_FEATURES, | 
|  | 721 | .flags		= PHY_HAS_INTERRUPT, | 
|  | 722 | .config_init	= brcm_fet_config_init, | 
|  | 723 | .ack_interrupt	= brcm_fet_ack_interrupt, | 
|  | 724 | .config_intr	= brcm_fet_config_intr, | 
|  | 725 | }, { | 
|  | 726 | .phy_id		= PHY_ID_BCM5395, | 
|  | 727 | .phy_id_mask	= 0xfffffff0, | 
|  | 728 | .name		= "Broadcom BCM5395", | 
|  | 729 | .flags		= PHY_IS_INTERNAL, | 
|  | 730 | .features	= PHY_GBIT_FEATURES, | 
|  | 731 | .get_sset_count	= bcm_phy_get_sset_count, | 
|  | 732 | .get_strings	= bcm_phy_get_strings, | 
|  | 733 | .get_stats	= bcm53xx_phy_get_stats, | 
|  | 734 | .probe		= bcm53xx_phy_probe, | 
|  | 735 | }, { | 
|  | 736 | .phy_id         = PHY_ID_BCM89610, | 
|  | 737 | .phy_id_mask    = 0xfffffff0, | 
|  | 738 | .name           = "Broadcom BCM89610", | 
|  | 739 | .features       = PHY_GBIT_FEATURES, | 
|  | 740 | .flags          = PHY_HAS_INTERRUPT, | 
|  | 741 | .config_init    = bcm54xx_config_init, | 
|  | 742 | .ack_interrupt  = bcm_phy_ack_intr, | 
|  | 743 | .config_intr    = bcm_phy_config_intr, | 
|  | 744 | } }; | 
|  | 745 |  | 
|  | 746 | module_phy_driver(broadcom_drivers); | 
|  | 747 |  | 
|  | 748 | static struct mdio_device_id __maybe_unused broadcom_tbl[] = { | 
|  | 749 | { PHY_ID_BCM5411, 0xfffffff0 }, | 
|  | 750 | { PHY_ID_BCM5421, 0xfffffff0 }, | 
|  | 751 | { PHY_ID_BCM54210E, 0xfffffff0 }, | 
|  | 752 | { PHY_ID_BCM5461, 0xfffffff0 }, | 
|  | 753 | { PHY_ID_BCM54612E, 0xfffffff0 }, | 
|  | 754 | { PHY_ID_BCM54616S, 0xfffffff0 }, | 
|  | 755 | { PHY_ID_BCM5464, 0xfffffff0 }, | 
|  | 756 | { PHY_ID_BCM5481, 0xfffffff0 }, | 
|  | 757 | { PHY_ID_BCM54810, 0xfffffff0 }, | 
|  | 758 | { PHY_ID_BCM5482, 0xfffffff0 }, | 
|  | 759 | { PHY_ID_BCM50610, 0xfffffff0 }, | 
|  | 760 | { PHY_ID_BCM50610M, 0xfffffff0 }, | 
|  | 761 | { PHY_ID_BCM57780, 0xfffffff0 }, | 
|  | 762 | { PHY_ID_BCMAC131, 0xfffffff0 }, | 
|  | 763 | { PHY_ID_BCM5241, 0xfffffff0 }, | 
|  | 764 | { PHY_ID_BCM5395, 0xfffffff0 }, | 
|  | 765 | { PHY_ID_BCM89610, 0xfffffff0 }, | 
|  | 766 | { } | 
|  | 767 | }; | 
|  | 768 |  | 
|  | 769 | MODULE_DEVICE_TABLE(mdio, broadcom_tbl); |