drivers/net/phy/bcm87xx.c

   1 /*
   2  * This file is subject to the terms and conditions of the GNU General Public
   3  * License.  See the file "COPYING" in the main directory of this archive
   4  * for more details.
   5  *
   6  * Copyright (C) 2011 - 2012 Cavium, Inc.
   7  */
   8
   9 #include <linux/module.h>
  10 #include <linux/phy.h>
  11 #include <linux/of.h>
  12
  13 #define PHY_ID_BCM8706  0x0143bdc1
  14 #define PHY_ID_BCM8727  0x0143bff0
  15
  16 #define BCM87XX_PMD_RX_SIGNAL_DETECT    (MII_ADDR_C45 | 0x1000a)
  17 #define BCM87XX_10GBASER_PCS_STATUS     (MII_ADDR_C45 | 0x30020)
  18 #define BCM87XX_XGXS_LANE_STATUS        (MII_ADDR_C45 | 0x40018)
  19
  20 #define BCM87XX_LASI_CONTROL (MII_ADDR_C45 | 0x39002)
  21 #define BCM87XX_LASI_STATUS (MII_ADDR_C45 | 0x39005)
  22
  23 #if IS_ENABLED(CONFIG_OF_MDIO)
  24 /* Set and/or override some configuration registers based on the
  25  * broadcom,c45-reg-init property stored in the of_node for the phydev.
  26  *
  27  * broadcom,c45-reg-init = <devid reg mask value>,...;
  28  *
  29  * There may be one or more sets of <devid reg mask value>:
  30  *
  31  * devid: which sub-device to use.
  32  * reg: the register.
  33  * mask: if non-zero, ANDed with existing register value.
  34  * value: ORed with the masked value and written to the regiser.
  35  *
  36  */
  37 static int bcm87xx_of_reg_init(struct phy_device *phydev)
  38 {
  39         const __be32 *paddr;
  40         const __be32 *paddr_end;
  41         int len, ret;
  42
  43         if (!phydev->dev.of_node)
  44                 return 0;
  45
  46         paddr = of_get_property(phydev->dev.of_node,
  47                                 "broadcom,c45-reg-init", &len);
  48         if (!paddr)
  49                 return 0;
  50
  51         paddr_end = paddr + (len /= sizeof(*paddr));
  52
  53         ret = 0;
  54
  55         while (paddr + 3 < paddr_end) {
  56                 u16 devid       = be32_to_cpup(paddr++);
  57                 u16 reg         = be32_to_cpup(paddr++);
  58                 u16 mask        = be32_to_cpup(paddr++);
  59                 u16 val_bits    = be32_to_cpup(paddr++);
  60                 int val;
  61                 u32 regnum = MII_ADDR_C45 | (devid << 16) | reg;
  62                 val = 0;
  63                 if (mask) {
  64                         val = phy_read(phydev, regnum);
  65                         if (val < 0) {
  66                                 ret = val;
  67                                 goto err;
  68                         }
  69                         val &= mask;
  70                 }
  71                 val |= val_bits;
  72
  73                 ret = phy_write(phydev, regnum, val);
  74                 if (ret < 0)
  75                         goto err;
  76         }
  77 err:
  78         return ret;
  79 }
  80 #else
  81 static int bcm87xx_of_reg_init(struct phy_device *phydev)
  82 {
  83         return 0;
  84 }
  85 #endif /* CONFIG_OF_MDIO */
  86
  87 static int bcm87xx_config_init(struct phy_device *phydev)
  88 {
  89         phydev->supported = SUPPORTED_10000baseR_FEC;
  90         phydev->advertising = ADVERTISED_10000baseR_FEC;
  91         phydev->state = PHY_NOLINK;
  92         phydev->autoneg = AUTONEG_DISABLE;
  93
  94         bcm87xx_of_reg_init(phydev);
  95
  96         return 0;
  97 }
  98
  99 static int bcm87xx_config_aneg(struct phy_device *phydev)
 100 {
 101         return -EINVAL;
 102 }
 103
 104 static int bcm87xx_read_status(struct phy_device *phydev)
 105 {
 106         int rx_signal_detect;
 107         int pcs_status;
 108         int xgxs_lane_status;
 109
 110         rx_signal_detect = phy_read(phydev, BCM87XX_PMD_RX_SIGNAL_DETECT);
 111         if (rx_signal_detect < 0)
 112                 return rx_signal_detect;
 113
 114         if ((rx_signal_detect & 1) == 0)
 115                 goto no_link;
 116
 117         pcs_status = phy_read(phydev, BCM87XX_10GBASER_PCS_STATUS);
 118         if (pcs_status < 0)
 119                 return pcs_status;
 120
 121         if ((pcs_status & 1) == 0)
 122                 goto no_link;
 123
 124         xgxs_lane_status = phy_read(phydev, BCM87XX_XGXS_LANE_STATUS);
 125         if (xgxs_lane_status < 0)
 126                 return xgxs_lane_status;
 127
 128         if ((xgxs_lane_status & 0x1000) == 0)
 129                 goto no_link;
 130
 131         phydev->speed = 10000;
 132         phydev->link = 1;
 133         phydev->duplex = 1;
 134         return 0;
 135
 136 no_link:
 137         phydev->link = 0;
 138         return 0;
 139 }
 140
 141 static int bcm87xx_config_intr(struct phy_device *phydev)
 142 {
 143         int reg, err;
 144
 145         reg = phy_read(phydev, BCM87XX_LASI_CONTROL);
 146
 147         if (reg < 0)
 148                 return reg;
 149
 150         if (phydev->interrupts == PHY_INTERRUPT_ENABLED)
 151                 reg |= 1;
 152         else
 153                 reg &= ~1;
 154
 155         err = phy_write(phydev, BCM87XX_LASI_CONTROL, reg);
 156         return err;
 157 }
 158
 159 static int bcm87xx_did_interrupt(struct phy_device *phydev)
 160 {
 161         int reg;
 162
 163         reg = phy_read(phydev, BCM87XX_LASI_STATUS);
 164
 165         if (reg < 0) {
 166                 dev_err(&phydev->dev,
 167                         "Error: Read of BCM87XX_LASI_STATUS failed: %d\n", reg);
 168                 return 0;
 169         }
 170         return (reg & 1) != 0;
 171 }
 172
 173 static int bcm87xx_ack_interrupt(struct phy_device *phydev)
 174 {
 175         /* Reading the LASI status clears it. */
 176         bcm87xx_did_interrupt(phydev);
 177         return 0;
 178 }
 179
 180 static int bcm8706_match_phy_device(struct phy_device *phydev)
 181 {
 182         return phydev->c45_ids.device_ids[4] == PHY_ID_BCM8706;
 183 }
 184
 185 static int bcm8727_match_phy_device(struct phy_device *phydev)
 186 {
 187         return phydev->c45_ids.device_ids[4] == PHY_ID_BCM8727;
 188 }
 189
 190 static struct phy_driver bcm87xx_driver[] = {
 191 {
 192         .phy_id         = PHY_ID_BCM8706,
 193         .phy_id_mask    = 0xffffffff,
 194         .name           = "Broadcom BCM8706",
 195         .flags          = PHY_HAS_INTERRUPT,
 196         .config_init    = bcm87xx_config_init,
 197         .config_aneg    = bcm87xx_config_aneg,
 198         .read_status    = bcm87xx_read_status,
 199         .ack_interrupt  = bcm87xx_ack_interrupt,
 200         .config_intr    = bcm87xx_config_intr,
 201         .did_interrupt  = bcm87xx_did_interrupt,
 202         .match_phy_device = bcm8706_match_phy_device,
 203         .driver         = { .owner = THIS_MODULE },
 204 }, {
 205         .phy_id         = PHY_ID_BCM8727,
 206         .phy_id_mask    = 0xffffffff,
 207         .name           = "Broadcom BCM8727",
 208         .flags          = PHY_HAS_INTERRUPT,
 209         .config_init    = bcm87xx_config_init,
 210         .config_aneg    = bcm87xx_config_aneg,
 211         .read_status    = bcm87xx_read_status,
 212         .ack_interrupt  = bcm87xx_ack_interrupt,
 213         .config_intr    = bcm87xx_config_intr,
 214         .did_interrupt  = bcm87xx_did_interrupt,
 215         .match_phy_device = bcm8727_match_phy_device,
 216         .driver         = { .owner = THIS_MODULE },
 217 } };
 218
 219 static int __init bcm87xx_init(void)
 220 {
 221         return phy_drivers_register(bcm87xx_driver,
 222                 ARRAY_SIZE(bcm87xx_driver));
 223 }
 224 module_init(bcm87xx_init);
 225
 226 static void __exit bcm87xx_exit(void)
 227 {
 228         phy_drivers_unregister(bcm87xx_driver,
 229                 ARRAY_SIZE(bcm87xx_driver));
 230 }
 231 module_exit(bcm87xx_exit);
 232
 233 MODULE_LICENSE("GPL");