drivers/net/phy/aquantia.c

   1 /*
   2  * Aquantia PHY drivers
   3  *
   4  * SPDX-License-Identifier:     GPL-2.0+
   5  *
   6  * Copyright 2014 Freescale Semiconductor, Inc.
   7  */
   8 #include <config.h>
   9 #include <common.h>
  10 #include <phy.h>
  11
  12 #ifndef CONFIG_PHYLIB_10G
  13 #error The Aquantia PHY needs 10G support
  14 #endif
  15
  16 #define AQUNTIA_10G_CTL         0x20
  17 #define AQUNTIA_VENDOR_P1       0xc400
  18
  19 #define AQUNTIA_SPEED_LSB_MASK  0x2000
  20 #define AQUNTIA_SPEED_MSB_MASK  0x40
  21
  22 int aquantia_config(struct phy_device *phydev)
  23 {
  24         u32 val = phy_read(phydev, MDIO_MMD_PMAPMD, MII_BMCR);
  25
  26         if (phydev->interface == PHY_INTERFACE_MODE_SGMII) {
  27                 /* 1000BASE-T mode */
  28                 phydev->advertising = SUPPORTED_1000baseT_Full;
  29                 phydev->supported = phydev->advertising;
  30
  31                 val = (val & ~AQUNTIA_SPEED_LSB_MASK) | AQUNTIA_SPEED_MSB_MASK;
  32                 phy_write(phydev, MDIO_MMD_PMAPMD, MII_BMCR, val);
  33         } else if (phydev->interface == PHY_INTERFACE_MODE_XGMII) {
  34                 /* 10GBASE-T mode */
  35                 phydev->advertising = SUPPORTED_10000baseT_Full;
  36                 phydev->supported = phydev->advertising;
  37
  38                 if (!(val & AQUNTIA_SPEED_LSB_MASK) ||
  39                     !(val & AQUNTIA_SPEED_MSB_MASK))
  40                         phy_write(phydev, MDIO_MMD_PMAPMD, MII_BMCR,
  41                                   AQUNTIA_SPEED_LSB_MASK |
  42                                   AQUNTIA_SPEED_MSB_MASK);
  43         } else if (phydev->interface == PHY_INTERFACE_MODE_SGMII_2500) {
  44                 /* 2.5GBASE-T mode */
  45                 phydev->advertising = SUPPORTED_1000baseT_Full;
  46                 phydev->supported = phydev->advertising;
  47
  48                 phy_write(phydev, MDIO_MMD_AN, AQUNTIA_10G_CTL, 1);
  49                 phy_write(phydev, MDIO_MMD_AN, AQUNTIA_VENDOR_P1, 0x9440);
  50         } else if (phydev->interface == PHY_INTERFACE_MODE_MII) {
  51                 /* 100BASE-TX mode */
  52                 phydev->advertising = SUPPORTED_100baseT_Full;
  53                 phydev->supported = phydev->advertising;
  54
  55                 val = (val & ~AQUNTIA_SPEED_MSB_MASK) | AQUNTIA_SPEED_LSB_MASK;
  56                 phy_write(phydev, MDIO_MMD_PMAPMD, MII_BMCR, val);
  57         }
  58         return 0;
  59 }
  60
  61 int aquantia_startup(struct phy_device *phydev)
  62 {
  63         u32 reg, speed;
  64         int i = 0;
  65
  66         phydev->duplex = DUPLEX_FULL;
  67
  68         /* if the AN is still in progress, wait till timeout. */
  69         phy_read(phydev, MDIO_MMD_AN, MDIO_STAT1);
  70         reg = phy_read(phydev, MDIO_MMD_AN, MDIO_STAT1);
  71         if (!(reg & MDIO_AN_STAT1_COMPLETE)) {
  72                 printf("%s Waiting for PHY auto negotiation to complete",
  73                        phydev->dev->name);
  74                 do {
  75                         udelay(1000);
  76                         reg = phy_read(phydev, MDIO_MMD_AN, MDIO_STAT1);
  77                         if ((i++ % 500) == 0)
  78                                 printf(".");
  79                 } while (!(reg & MDIO_AN_STAT1_COMPLETE) &&
  80                          i < (4 * PHY_ANEG_TIMEOUT));
  81
  82                 if (i > PHY_ANEG_TIMEOUT)
  83                         printf(" TIMEOUT !\n");
  84         }
  85
  86         /* Read twice because link state is latched and a
  87          * read moves the current state into the register */
  88         phy_read(phydev, MDIO_MMD_AN, MDIO_STAT1);
  89         reg = phy_read(phydev, MDIO_MMD_AN, MDIO_STAT1);
  90         if (reg < 0 || !(reg & MDIO_STAT1_LSTATUS))
  91                 phydev->link = 0;
  92         else
  93                 phydev->link = 1;
  94
  95         speed = phy_read(phydev, MDIO_MMD_PMAPMD, MII_BMCR);
  96         if (speed & AQUNTIA_SPEED_MSB_MASK) {
  97                 if (speed & AQUNTIA_SPEED_LSB_MASK)
  98                         phydev->speed = SPEED_10000;
  99                 else
 100                         phydev->speed = SPEED_1000;
 101         } else {
 102                 if (speed & AQUNTIA_SPEED_LSB_MASK)
 103                         phydev->speed = SPEED_100;
 104                 else
 105                         phydev->speed = SPEED_10;
 106         }
 107
 108         return 0;
 109 }
 110
 111 struct phy_driver aq1202_driver = {
 112         .name = "Aquantia AQ1202",
 113         .uid = 0x3a1b445,
 114         .mask = 0xfffffff0,
 115         .features = PHY_10G_FEATURES,
 116         .mmds = (MDIO_MMD_PMAPMD | MDIO_MMD_PCS|
 117                         MDIO_MMD_PHYXS | MDIO_MMD_AN |
 118                         MDIO_MMD_VEND1),
 119         .config = &aquantia_config,
 120         .startup = &aquantia_startup,
 121         .shutdown = &gen10g_shutdown,
 122 };
 123
 124 struct phy_driver aq2104_driver = {
 125         .name = "Aquantia AQ2104",
 126         .uid = 0x3a1b460,
 127         .mask = 0xfffffff0,
 128         .features = PHY_10G_FEATURES,
 129         .mmds = (MDIO_MMD_PMAPMD | MDIO_MMD_PCS|
 130                         MDIO_MMD_PHYXS | MDIO_MMD_AN |
 131                         MDIO_MMD_VEND1),
 132         .config = &aquantia_config,
 133         .startup = &aquantia_startup,
 134         .shutdown = &gen10g_shutdown,
 135 };
 136
 137 struct phy_driver aqr105_driver = {
 138         .name = "Aquantia AQR105",
 139         .uid = 0x3a1b4a2,
 140         .mask = 0xfffffff0,
 141         .features = PHY_10G_FEATURES,
 142         .mmds = (MDIO_MMD_PMAPMD | MDIO_MMD_PCS|
 143                         MDIO_MMD_PHYXS | MDIO_MMD_AN |
 144                         MDIO_MMD_VEND1),
 145         .config = &aquantia_config,
 146         .startup = &aquantia_startup,
 147         .shutdown = &gen10g_shutdown,
 148 };
 149 int phy_aquantia_init(void)
 150 {
 151         phy_register(&aq1202_driver);
 152         phy_register(&aq2104_driver);
 153         phy_register(&aqr105_driver);
 154
 155         return 0;
 156 }