drivers/net/phy/smsc.c

   1 /*
   2  * SMSC PHY drivers
   3  *
   4  * SPDX-License-Identifier:     GPL-2.0+
   5  *
   6  * Base code from drivers/net/phy/davicom.c
   7  *   Copyright 2010-2011 Freescale Semiconductor, Inc.
   8  *   author Andy Fleming
   9  *
  10  * Some code get from linux kenrel
  11  * Copyright (c) 2006 Herbert Valerio Riedel <hvr@gnu.org>
  12  */
  13 #include <miiphy.h>
  14 #include <errno.h>
  15
  16 #define MII_LAN83C185_CTRL_STATUS       17 /* Mode/Status Register */
  17 #define MII_LAN83C185_EDPWRDOWN         (1 << 13) /* EDPWRDOWN */
  18 #define MII_LAN83C185_ENERGYON          (1 << 1)  /* ENERGYON */
  19
  20 static int smsc_parse_status(struct phy_device *phydev)
  21 {
  22         int bmcr;
  23         int aneg_exp;
  24         int mii_adv;
  25         int lpa;
  26
  27         aneg_exp = phy_read(phydev, MDIO_DEVAD_NONE, MII_EXPANSION);
  28         if (aneg_exp < 0)
  29                 return aneg_exp;
  30
  31         if (aneg_exp & EXPANSION_MFAULTS) {
  32                 /* second read to clear latched status */
  33                 aneg_exp = phy_read(phydev, MDIO_DEVAD_NONE, MII_EXPANSION);
  34                 if (aneg_exp & EXPANSION_MFAULTS)
  35                         return -EIO;
  36         }
  37
  38         bmcr = phy_read(phydev, MDIO_DEVAD_NONE, MII_BMCR);
  39         if (bmcr < 0)
  40                 return bmcr;
  41         if (bmcr & BMCR_ANENABLE) {
  42                 lpa = phy_read(phydev, MDIO_DEVAD_NONE, MII_LPA);
  43                 if (lpa < 0)
  44                         return lpa;
  45                 mii_adv = phy_read(phydev, MDIO_DEVAD_NONE, MII_ADVERTISE);
  46                 if (mii_adv < 0)
  47                         return mii_adv;
  48                 lpa &= mii_adv;
  49
  50                 if (!(aneg_exp & EXPANSION_NWAY)) {
  51                         /* parallel detection */
  52                         phydev->duplex = DUPLEX_HALF;
  53                         if (lpa & (LPA_100HALF | LPA_100FULL))
  54                                 phydev->speed = SPEED_100;
  55                         else
  56                                 phydev->speed = SPEED_10;
  57                 }
  58
  59                 if (lpa & (LPA_100FULL | LPA_100HALF)) {
  60                         phydev->speed = SPEED_100;
  61                         if (lpa & LPA_100FULL)
  62                                 phydev->duplex = DUPLEX_FULL;
  63                         else
  64                                 phydev->duplex = DUPLEX_HALF;
  65                 } else if (lpa & (LPA_10FULL | LPA_10HALF)) {
  66                         phydev->speed = SPEED_10;
  67                         if (lpa & LPA_10FULL)
  68                                 phydev->duplex = DUPLEX_FULL;
  69                         else
  70                                 phydev->duplex = DUPLEX_HALF;
  71                 } else {
  72                         return -EINVAL;
  73                 }
  74         } else {
  75                 if (bmcr & BMCR_SPEED100)
  76                         phydev->speed = SPEED_100;
  77                 else
  78                         phydev->speed = SPEED_10;
  79
  80                 if (bmcr & BMCR_FULLDPLX)
  81                         phydev->duplex = DUPLEX_FULL;
  82                 else
  83                         phydev->duplex = DUPLEX_HALF;
  84         }
  85         return 0;
  86 }
  87
  88 static int smsc_startup(struct phy_device *phydev)
  89 {
  90         int ret;
  91
  92         if (!phydev->link) {
  93                 /* Disable EDPD to wake up PHY */
  94                 ret = phy_read(phydev, MDIO_DEVAD_NONE, MII_LAN83C185_CTRL_STATUS);
  95
  96                 if (ret < 0)
  97                         return ret;
  98
  99                 if (ret & MII_LAN83C185_EDPWRDOWN) {
 100                         ret = phy_write(phydev, MDIO_DEVAD_NONE, MII_LAN83C185_CTRL_STATUS,
 101                                 ret & ~MII_LAN83C185_EDPWRDOWN);
 102                         if (ret < 0)
 103                                 return ret;
 104
 105                         /* Sleep 64 ms to allow ~5 link test pulses to be sent */
 106                         udelay(64 * 1000);
 107                 }
 108         }
 109
 110         ret = genphy_update_link(phydev);
 111         if (ret < 0)
 112                 return ret;
 113         return smsc_parse_status(phydev);
 114 }
 115
 116 static struct phy_driver lan8700_driver = {
 117         .name = "SMSC LAN8700",
 118         .uid = 0x0007c0c0,
 119         .mask = 0xffff0,
 120         .features = PHY_BASIC_FEATURES,
 121         .config = &genphy_config_aneg,
 122         .startup = &smsc_startup,
 123         .shutdown = &genphy_shutdown,
 124 };
 125
 126 static struct phy_driver lan911x_driver = {
 127         .name = "SMSC LAN911x Internal PHY",
 128         .uid = 0x0007c0d0,
 129         .mask = 0xffff0,
 130         .features = PHY_BASIC_FEATURES,
 131         .config = &genphy_config_aneg,
 132         .startup = &smsc_startup,
 133         .shutdown = &genphy_shutdown,
 134 };
 135
 136 static struct phy_driver lan8710_driver = {
 137         .name = "SMSC LAN8710/LAN8720",
 138         .uid = 0x0007c0f0,
 139         .mask = 0xffff0,
 140         .features = PHY_GBIT_FEATURES,
 141         .config = &genphy_config_aneg,
 142         .startup = &smsc_startup,
 143         .shutdown = &genphy_shutdown,
 144 };
 145
 146 int phy_smsc_init(void)
 147 {
 148         phy_register(&lan8710_driver);
 149         phy_register(&lan911x_driver);
 150         phy_register(&lan8700_driver);
 151
 152         return 0;
 153 }