drivers/net/phy/bcm7xxx.c

   1 /*
   2  * Broadcom BCM7xxx internal transceivers support.
   3  *
   4  * Copyright (C) 2014, Broadcom Corporation
   5  *
   6  * This program is free software; you can redistribute it and/or
   7  * modify it under the terms of the GNU General Public License
   8  * as published by the Free Software Foundation; either version
   9  * 2 of the License, or (at your option) any later version.
  10  */
  11
  12 #include <linux/module.h>
  13 #include <linux/phy.h>
  14 #include <linux/delay.h>
  15 #include <linux/bitops.h>
  16 #include <linux/brcmphy.h>
  17 #include <linux/mdio.h>
  18
  19 /* Broadcom BCM7xxx internal PHY registers */
  20 #define MII_BCM7XXX_CHANNEL_WIDTH       0x2000
  21
  22 /* 40nm only register definitions */
  23 #define MII_BCM7XXX_100TX_AUX_CTL       0x10
  24 #define MII_BCM7XXX_100TX_FALSE_CAR     0x13
  25 #define MII_BCM7XXX_100TX_DISC          0x14
  26 #define MII_BCM7XXX_AUX_MODE            0x1d
  27 #define  MII_BCM7XX_64CLK_MDIO          BIT(12)
  28 #define MII_BCM7XXX_CORE_BASE1E         0x1e
  29 #define MII_BCM7XXX_TEST                0x1f
  30 #define  MII_BCM7XXX_SHD_MODE_2         BIT(2)
  31
  32 /* 28nm only register definitions */
  33 #define MISC_ADDR(base, channel)        base, channel
  34
  35 #define DSP_TAP10                       MISC_ADDR(0x0a, 0)
  36 #define PLL_PLLCTRL_1                   MISC_ADDR(0x32, 1)
  37 #define PLL_PLLCTRL_2                   MISC_ADDR(0x32, 2)
  38 #define PLL_PLLCTRL_4                   MISC_ADDR(0x33, 0)
  39
  40 #define AFE_RXCONFIG_0                  MISC_ADDR(0x38, 0)
  41 #define AFE_RXCONFIG_1                  MISC_ADDR(0x38, 1)
  42 #define AFE_RX_LP_COUNTER               MISC_ADDR(0x38, 3)
  43 #define AFE_TX_CONFIG                   MISC_ADDR(0x39, 0)
  44 #define AFE_HPF_TRIM_OTHERS             MISC_ADDR(0x3a, 0)
  45
  46 #define CORE_EXPB0                      0xb0
  47
  48 static int bcm7445_config_init(struct phy_device *phydev)
  49 {
  50         int ret;
  51         const struct bcm7445_regs {
  52                 int reg;
  53                 u16 value;
  54         } bcm7445_regs_cfg[] = {
  55                 /* increases ADC latency by 24ns */
  56                 { MII_BCM54XX_EXP_SEL, 0x0038 },
  57                 { MII_BCM54XX_EXP_DATA, 0xAB95 },
  58                 /* increases internal 1V LDO voltage by 5% */
  59                 { MII_BCM54XX_EXP_SEL, 0x2038 },
  60                 { MII_BCM54XX_EXP_DATA, 0xBB22 },
  61                 /* reduce RX low pass filter corner frequency */
  62                 { MII_BCM54XX_EXP_SEL, 0x6038 },
  63                 { MII_BCM54XX_EXP_DATA, 0xFFC5 },
  64                 /* reduce RX high pass filter corner frequency */
  65                 { MII_BCM54XX_EXP_SEL, 0x003a },
  66                 { MII_BCM54XX_EXP_DATA, 0x2002 },
  67         };
  68         unsigned int i;
  69
  70         for (i = 0; i < ARRAY_SIZE(bcm7445_regs_cfg); i++) {
  71                 ret = phy_write(phydev,
  72                                 bcm7445_regs_cfg[i].reg,
  73                                 bcm7445_regs_cfg[i].value);
  74                 if (ret)
  75                         return ret;
  76         }
  77
  78         return 0;
  79 }
  80
  81 static void phy_write_exp(struct phy_device *phydev,
  82                                         u16 reg, u16 value)
  83 {
  84         phy_write(phydev, MII_BCM54XX_EXP_SEL, MII_BCM54XX_EXP_SEL_ER | reg);
  85         phy_write(phydev, MII_BCM54XX_EXP_DATA, value);
  86 }
  87
  88 static void phy_write_misc(struct phy_device *phydev,
  89                                         u16 reg, u16 chl, u16 value)
  90 {
  91         int tmp;
  92
  93         phy_write(phydev, MII_BCM54XX_AUX_CTL, MII_BCM54XX_AUXCTL_SHDWSEL_MISC);
  94
  95         tmp = phy_read(phydev, MII_BCM54XX_AUX_CTL);
  96         tmp |= MII_BCM54XX_AUXCTL_ACTL_SMDSP_ENA;
  97         phy_write(phydev, MII_BCM54XX_AUX_CTL, tmp);
  98
  99         tmp = (chl * MII_BCM7XXX_CHANNEL_WIDTH) | reg;
 100         phy_write(phydev, MII_BCM54XX_EXP_SEL, tmp);
 101
 102         phy_write(phydev, MII_BCM54XX_EXP_DATA, value);
 103 }
 104
 105 static int bcm7xxx_28nm_afe_config_init(struct phy_device *phydev)
 106 {
 107         /* Increase VCO range to prevent unlocking problem of PLL at low
 108          * temp
 109          */
 110         phy_write_misc(phydev, PLL_PLLCTRL_1, 0x0048);
 111
 112         /* Change Ki to 011 */
 113         phy_write_misc(phydev, PLL_PLLCTRL_2, 0x021b);
 114
 115         /* Disable loading of TVCO buffer to bandgap, set bandgap trim
 116          * to 111
 117          */
 118         phy_write_misc(phydev, PLL_PLLCTRL_4, 0x0e20);
 119
 120         /* Adjust bias current trim by -3 */
 121         phy_write_misc(phydev, DSP_TAP10, 0x690b);
 122
 123         /* Switch to CORE_BASE1E */
 124         phy_write(phydev, MII_BCM7XXX_CORE_BASE1E, 0xd);
 125
 126         /* Reset R_CAL/RC_CAL Engine */
 127         phy_write_exp(phydev, CORE_EXPB0, 0x0010);
 128
 129         /* Disable Reset R_CAL/RC_CAL Engine */
 130         phy_write_exp(phydev, CORE_EXPB0, 0x0000);
 131
 132         /* write AFE_RXCONFIG_0 */
 133         phy_write_misc(phydev, AFE_RXCONFIG_0, 0xeb19);
 134
 135         /* write AFE_RXCONFIG_1 */
 136         phy_write_misc(phydev, AFE_RXCONFIG_1, 0x9a3f);
 137
 138         /* write AFE_RX_LP_COUNTER */
 139         phy_write_misc(phydev, AFE_RX_LP_COUNTER, 0x7fc0);
 140
 141         /* write AFE_HPF_TRIM_OTHERS */
 142         phy_write_misc(phydev, AFE_HPF_TRIM_OTHERS, 0x000b);
 143
 144         /* write AFTE_TX_CONFIG */
 145         phy_write_misc(phydev, AFE_TX_CONFIG, 0x0800);
 146
 147         return 0;
 148 }
 149
 150 static int bcm7xxx_apd_enable(struct phy_device *phydev)
 151 {
 152         int val;
 153
 154         /* Enable powering down of the DLL during auto-power down */
 155         val = bcm54xx_shadow_read(phydev, BCM54XX_SHD_SCR3);
 156         if (val < 0)
 157                 return val;
 158
 159         val |= BCM54XX_SHD_SCR3_DLLAPD_DIS;
 160         bcm54xx_shadow_write(phydev, BCM54XX_SHD_SCR3, val);
 161
 162         /* Enable auto-power down */
 163         val = bcm54xx_shadow_read(phydev, BCM54XX_SHD_APD);
 164         if (val < 0)
 165                 return val;
 166
 167         val |= BCM54XX_SHD_APD_EN;
 168         return bcm54xx_shadow_write(phydev, BCM54XX_SHD_APD, val);
 169 }
 170
 171 static int bcm7xxx_eee_enable(struct phy_device *phydev)
 172 {
 173         int val;
 174
 175         val = phy_read_mmd_indirect(phydev, BRCM_CL45VEN_EEE_CONTROL,
 176                                     MDIO_MMD_AN, phydev->addr);
 177         if (val < 0)
 178                 return val;
 179
 180         /* Enable general EEE feature at the PHY level */
 181         val |= LPI_FEATURE_EN | LPI_FEATURE_EN_DIG1000X;
 182
 183         phy_write_mmd_indirect(phydev, BRCM_CL45VEN_EEE_CONTROL,
 184                                MDIO_MMD_AN, phydev->addr, val);
 185
 186         /* Advertise supported modes */
 187         val = phy_read_mmd_indirect(phydev, MDIO_AN_EEE_ADV,
 188                                     MDIO_MMD_AN, phydev->addr);
 189
 190         val |= (MDIO_AN_EEE_ADV_100TX | MDIO_AN_EEE_ADV_1000T);
 191         phy_write_mmd_indirect(phydev, MDIO_AN_EEE_ADV,
 192                                MDIO_MMD_AN, phydev->addr, val);
 193
 194         return 0;
 195 }
 196
 197 static int bcm7xxx_28nm_config_init(struct phy_device *phydev)
 198 {
 199         int ret;
 200
 201         ret = bcm7445_config_init(phydev);
 202         if (ret)
 203                 return ret;
 204
 205         ret = bcm7xxx_28nm_afe_config_init(phydev);
 206         if (ret)
 207                 return ret;
 208
 209         ret = bcm7xxx_eee_enable(phydev);
 210         if (ret)
 211                 return ret;
 212
 213         return bcm7xxx_apd_enable(phydev);
 214 }
 215
 216 static int bcm7xxx_28nm_resume(struct phy_device *phydev)
 217 {
 218         int ret;
 219
 220         /* Re-apply workarounds coming out suspend/resume */
 221         ret = bcm7xxx_28nm_config_init(phydev);
 222         if (ret)
 223                 return ret;
 224
 225         /* 28nm Gigabit PHYs come out of reset without any half-duplex
 226          * or "hub" compliant advertised mode, fix that. This does not
 227          * cause any problems with the PHY library since genphy_config_aneg()
 228          * gracefully handles auto-negotiated and forced modes.
 229          */
 230         return genphy_config_aneg(phydev);
 231 }
 232
 233 static int phy_set_clr_bits(struct phy_device *dev, int location,
 234                                         int set_mask, int clr_mask)
 235 {
 236         int v, ret;
 237
 238         v = phy_read(dev, location);
 239         if (v < 0)
 240                 return v;
 241
 242         v &= ~clr_mask;
 243         v |= set_mask;
 244
 245         ret = phy_write(dev, location, v);
 246         if (ret < 0)
 247                 return ret;
 248
 249         return v;
 250 }
 251
 252 static int bcm7xxx_config_init(struct phy_device *phydev)
 253 {
 254         int ret;
 255
 256         /* Enable 64 clock MDIO */
 257         phy_write(phydev, MII_BCM7XXX_AUX_MODE, MII_BCM7XX_64CLK_MDIO);
 258         phy_read(phydev, MII_BCM7XXX_AUX_MODE);
 259
 260         /* Workaround only required for 100Mbits/sec */
 261         if (!(phydev->dev_flags & PHY_BRCM_100MBPS_WAR))
 262                 return 0;
 263
 264         /* set shadow mode 2 */
 265         ret = phy_set_clr_bits(phydev, MII_BCM7XXX_TEST,
 266                         MII_BCM7XXX_SHD_MODE_2, MII_BCM7XXX_SHD_MODE_2);
 267         if (ret < 0)
 268                 return ret;
 269
 270         /* set iddq_clkbias */
 271         phy_write(phydev, MII_BCM7XXX_100TX_DISC, 0x0F00);
 272         udelay(10);
 273
 274         /* reset iddq_clkbias */
 275         phy_write(phydev, MII_BCM7XXX_100TX_DISC, 0x0C00);
 276
 277         phy_write(phydev, MII_BCM7XXX_100TX_FALSE_CAR, 0x7555);
 278
 279         /* reset shadow mode 2 */
 280         ret = phy_set_clr_bits(phydev, MII_BCM7XXX_TEST, MII_BCM7XXX_SHD_MODE_2, 0);
 281         if (ret < 0)
 282                 return ret;
 283
 284         return 0;
 285 }
 286
 287 /* Workaround for putting the PHY in IDDQ mode, required
 288  * for all BCM7XXX 40nm and 65nm PHYs
 289  */
 290 static int bcm7xxx_suspend(struct phy_device *phydev)
 291 {
 292         int ret;
 293         const struct bcm7xxx_regs {
 294                 int reg;
 295                 u16 value;
 296         } bcm7xxx_suspend_cfg[] = {
 297                 { MII_BCM7XXX_TEST, 0x008b },
 298                 { MII_BCM7XXX_100TX_AUX_CTL, 0x01c0 },
 299                 { MII_BCM7XXX_100TX_DISC, 0x7000 },
 300                 { MII_BCM7XXX_TEST, 0x000f },
 301                 { MII_BCM7XXX_100TX_AUX_CTL, 0x20d0 },
 302                 { MII_BCM7XXX_TEST, 0x000b },
 303         };
 304         unsigned int i;
 305
 306         for (i = 0; i < ARRAY_SIZE(bcm7xxx_suspend_cfg); i++) {
 307                 ret = phy_write(phydev,
 308                                 bcm7xxx_suspend_cfg[i].reg,
 309                                 bcm7xxx_suspend_cfg[i].value);
 310                 if (ret)
 311                         return ret;
 312         }
 313
 314         return 0;
 315 }
 316
 317 static int bcm7xxx_dummy_config_init(struct phy_device *phydev)
 318 {
 319         return 0;
 320 }
 321
 322 #define BCM7XXX_28NM_GPHY(_oui, _name)                                  \
 323 {                                                                       \
 324         .phy_id         = (_oui),                                       \
 325         .phy_id_mask    = 0xfffffff0,                                   \
 326         .name           = _name,                                        \
 327         .features       = PHY_GBIT_FEATURES |                           \
 328                           SUPPORTED_Pause | SUPPORTED_Asym_Pause,       \
 329         .flags          = PHY_IS_INTERNAL,                              \
 330         .config_init    = bcm7xxx_28nm_afe_config_init,                 \
 331         .config_aneg    = genphy_config_aneg,                           \
 332         .read_status    = genphy_read_status,                           \
 333         .resume         = bcm7xxx_28nm_resume,                          \
 334         .driver         = { .owner = THIS_MODULE },                     \
 335 }
 336
 337 static struct phy_driver bcm7xxx_driver[] = {
 338         BCM7XXX_28NM_GPHY(PHY_ID_BCM7250, "Broadcom BCM7250"),
 339         BCM7XXX_28NM_GPHY(PHY_ID_BCM7364, "Broadcom BCM7364"),
 340         BCM7XXX_28NM_GPHY(PHY_ID_BCM7366, "Broadcom BCM7366"),
 341         BCM7XXX_28NM_GPHY(PHY_ID_BCM7439, "Broadcom BCM7439"),
 342         BCM7XXX_28NM_GPHY(PHY_ID_BCM7445, "Broadcom BCM7445"),
 343 {
 344         .phy_id         = PHY_BCM_OUI_4,
 345         .phy_id_mask    = 0xffff0000,
 346         .name           = "Broadcom BCM7XXX 40nm",
 347         .features       = PHY_GBIT_FEATURES |
 348                           SUPPORTED_Pause | SUPPORTED_Asym_Pause,
 349         .flags          = PHY_IS_INTERNAL,
 350         .config_init    = bcm7xxx_config_init,
 351         .config_aneg    = genphy_config_aneg,
 352         .read_status    = genphy_read_status,
 353         .suspend        = bcm7xxx_suspend,
 354         .resume         = bcm7xxx_config_init,
 355         .driver         = { .owner = THIS_MODULE },
 356 }, {
 357         .phy_id         = PHY_BCM_OUI_5,
 358         .phy_id_mask    = 0xffffff00,
 359         .name           = "Broadcom BCM7XXX 65nm",
 360         .features       = PHY_BASIC_FEATURES |
 361                           SUPPORTED_Pause | SUPPORTED_Asym_Pause,
 362         .flags          = PHY_IS_INTERNAL,
 363         .config_init    = bcm7xxx_dummy_config_init,
 364         .config_aneg    = genphy_config_aneg,
 365         .read_status    = genphy_read_status,
 366         .suspend        = bcm7xxx_suspend,
 367         .resume         = bcm7xxx_config_init,
 368         .driver         = { .owner = THIS_MODULE },
 369 } };
 370
 371 static struct mdio_device_id __maybe_unused bcm7xxx_tbl[] = {
 372         { PHY_ID_BCM7250, 0xfffffff0, },
 373         { PHY_ID_BCM7364, 0xfffffff0, },
 374         { PHY_ID_BCM7366, 0xfffffff0, },
 375         { PHY_ID_BCM7439, 0xfffffff0, },
 376         { PHY_ID_BCM7445, 0xfffffff0, },
 377         { PHY_BCM_OUI_4, 0xffff0000 },
 378         { PHY_BCM_OUI_5, 0xffffff00 },
 379         { }
 380 };
 381
 382 static int __init bcm7xxx_phy_init(void)
 383 {
 384         return phy_drivers_register(bcm7xxx_driver,
 385                         ARRAY_SIZE(bcm7xxx_driver));
 386 }
 387
 388 static void __exit bcm7xxx_phy_exit(void)
 389 {
 390         phy_drivers_unregister(bcm7xxx_driver,
 391                         ARRAY_SIZE(bcm7xxx_driver));
 392 }
 393
 394 module_init(bcm7xxx_phy_init);
 395 module_exit(bcm7xxx_phy_exit);
 396
 397 MODULE_DEVICE_TABLE(mdio, bcm7xxx_tbl);
 398
 399 MODULE_DESCRIPTION("Broadcom BCM7xxx internal PHY driver");
 400 MODULE_LICENSE("GPL");
 401 MODULE_AUTHOR("Broadcom Corporation");