phylib: add support for aquantia PHYs

This patch supports AQ1202, AQ2104, AQR105 PHY.

Signed-off-by: Shaohui Xie <Shaohui.Xie@freescale.com>
Acked-by: Joe Hershberger <joe.hershberger@ni.com>
Reviewed-by: York Sun <yorksun@freescale.com>

diff --git a/drivers/net/phy/Makefile b/drivers/net/phy/Makefile
index f46bf00abe459bc726eaca97b963c7dc84ec3107..d096db87a2766a6c02c2bbb984071f71533f17e3 100644 (file)
--- a/drivers/net/phy/Makefile
+++ b/drivers/net/phy/Makefile
@@ -11,6 +11,7 @@ obj-$(CONFIG_MV88E6352_SWITCH) += mv88e6352.o
 
 obj-$(CONFIG_PHYLIB) += phy.o
 obj-$(CONFIG_PHYLIB_10G) += generic_10g.o
+obj-$(CONFIG_PHY_AQUANTIA) += aquantia.o
 obj-$(CONFIG_PHY_ATHEROS) += atheros.o
 obj-$(CONFIG_PHY_BROADCOM) += broadcom.o
 obj-$(CONFIG_PHY_CORTINA) += cortina.o

diff --git a/drivers/net/phy/aquantia.c b/drivers/net/phy/aquantia.c
new file mode 100644 (file)
index 0000000..ef4da4e
--- /dev/null
+++ b/drivers/net/phy/aquantia.c
@@ -0,0 +1,156 @@
+/*
+ * Aquantia PHY drivers
+ *
+ * SPDX-License-Identifier:    GPL-2.0+
+ *
+ * Copyright 2014 Freescale Semiconductor, Inc.
+ */
+#include <config.h>
+#include <common.h>
+#include <phy.h>
+
+#ifndef CONFIG_PHYLIB_10G
+#error The Aquantia PHY needs 10G support
+#endif
+
+#define AQUNTIA_10G_CTL                0x20
+#define AQUNTIA_VENDOR_P1      0xc400
+
+#define AQUNTIA_SPEED_LSB_MASK 0x2000
+#define AQUNTIA_SPEED_MSB_MASK 0x40
+
+int aquantia_config(struct phy_device *phydev)
+{
+       u32 val = phy_read(phydev, MDIO_MMD_PMAPMD, MII_BMCR);
+
+       if (phydev->interface == PHY_INTERFACE_MODE_SGMII) {
+               /* 1000BASE-T mode */
+               phydev->advertising = SUPPORTED_1000baseT_Full;
+               phydev->supported = phydev->advertising;
+
+               val = (val & ~AQUNTIA_SPEED_LSB_MASK) | AQUNTIA_SPEED_MSB_MASK;
+               phy_write(phydev, MDIO_MMD_PMAPMD, MII_BMCR, val);
+       } else if (phydev->interface == PHY_INTERFACE_MODE_XGMII) {
+               /* 10GBASE-T mode */
+               phydev->advertising = SUPPORTED_10000baseT_Full;
+               phydev->supported = phydev->advertising;
+
+               if (!(val & AQUNTIA_SPEED_LSB_MASK) ||
+                   !(val & AQUNTIA_SPEED_MSB_MASK))
+                       phy_write(phydev, MDIO_MMD_PMAPMD, MII_BMCR,
+                                 AQUNTIA_SPEED_LSB_MASK |
+                                 AQUNTIA_SPEED_MSB_MASK);
+       } else if (phydev->interface == PHY_INTERFACE_MODE_SGMII_2500) {
+               /* 2.5GBASE-T mode */
+               phydev->advertising = SUPPORTED_1000baseT_Full;
+               phydev->supported = phydev->advertising;
+
+               phy_write(phydev, MDIO_MMD_AN, AQUNTIA_10G_CTL, 1);
+               phy_write(phydev, MDIO_MMD_AN, AQUNTIA_VENDOR_P1, 0x9440);
+       } else if (phydev->interface == PHY_INTERFACE_MODE_MII) {
+               /* 100BASE-TX mode */
+               phydev->advertising = SUPPORTED_100baseT_Full;
+               phydev->supported = phydev->advertising;
+
+               val = (val & ~AQUNTIA_SPEED_MSB_MASK) | AQUNTIA_SPEED_LSB_MASK;
+               phy_write(phydev, MDIO_MMD_PMAPMD, MII_BMCR, val);
+       }
+       return 0;
+}
+
+int aquantia_startup(struct phy_device *phydev)
+{
+       u32 reg, speed;
+       int i = 0;
+
+       phydev->duplex = DUPLEX_FULL;
+
+       /* if the AN is still in progress, wait till timeout. */
+       phy_read(phydev, MDIO_MMD_AN, MDIO_STAT1);
+       reg = phy_read(phydev, MDIO_MMD_AN, MDIO_STAT1);
+       if (!(reg & MDIO_AN_STAT1_COMPLETE)) {
+               printf("%s Waiting for PHY auto negotiation to complete",
+                      phydev->dev->name);
+               do {
+                       udelay(1000);
+                       reg = phy_read(phydev, MDIO_MMD_AN, MDIO_STAT1);
+                       if ((i++ % 500) == 0)
+                               printf(".");
+               } while (!(reg & MDIO_AN_STAT1_COMPLETE) &&
+                        i < (4 * PHY_ANEG_TIMEOUT));
+
+               if (i > PHY_ANEG_TIMEOUT)
+                       printf(" TIMEOUT !\n");
+       }
+
+       /* Read twice because link state is latched and a
+        * read moves the current state into the register */
+       phy_read(phydev, MDIO_MMD_AN, MDIO_STAT1);
+       reg = phy_read(phydev, MDIO_MMD_AN, MDIO_STAT1);
+       if (reg < 0 || !(reg & MDIO_STAT1_LSTATUS))
+               phydev->link = 0;
+       else
+               phydev->link = 1;
+
+       speed = phy_read(phydev, MDIO_MMD_PMAPMD, MII_BMCR);
+       if (speed & AQUNTIA_SPEED_MSB_MASK) {
+               if (speed & AQUNTIA_SPEED_LSB_MASK)
+                       phydev->speed = SPEED_10000;
+               else
+                       phydev->speed = SPEED_1000;
+       } else {
+               if (speed & AQUNTIA_SPEED_LSB_MASK)
+                       phydev->speed = SPEED_100;
+               else
+                       phydev->speed = SPEED_10;
+       }
+
+       return 0;
+}
+
+struct phy_driver aq1202_driver = {
+       .name = "Aquantia AQ1202",
+       .uid = 0x3a1b445,
+       .mask = 0xfffffff0,
+       .features = PHY_10G_FEATURES,
+       .mmds = (MDIO_MMD_PMAPMD | MDIO_MMD_PCS|
+                       MDIO_MMD_PHYXS | MDIO_MMD_AN |
+                       MDIO_MMD_VEND1),
+       .config = &aquantia_config,
+       .startup = &aquantia_startup,
+       .shutdown = &gen10g_shutdown,
+};
+
+struct phy_driver aq2104_driver = {
+       .name = "Aquantia AQ2104",
+       .uid = 0x3a1b460,
+       .mask = 0xfffffff0,
+       .features = PHY_10G_FEATURES,
+       .mmds = (MDIO_MMD_PMAPMD | MDIO_MMD_PCS|
+                       MDIO_MMD_PHYXS | MDIO_MMD_AN |
+                       MDIO_MMD_VEND1),
+       .config = &aquantia_config,
+       .startup = &aquantia_startup,
+       .shutdown = &gen10g_shutdown,
+};
+
+struct phy_driver aqr105_driver = {
+       .name = "Aquantia AQR105",
+       .uid = 0x3a1b4a2,
+       .mask = 0xfffffff0,
+       .features = PHY_10G_FEATURES,
+       .mmds = (MDIO_MMD_PMAPMD | MDIO_MMD_PCS|
+                       MDIO_MMD_PHYXS | MDIO_MMD_AN |
+                       MDIO_MMD_VEND1),
+       .config = &aquantia_config,
+       .startup = &aquantia_startup,
+       .shutdown = &gen10g_shutdown,
+};
+int phy_aquantia_init(void)
+{
+       phy_register(&aq1202_driver);
+       phy_register(&aq2104_driver);
+       phy_register(&aqr105_driver);
+
+       return 0;
+}

diff --git a/drivers/net/phy/phy.c b/drivers/net/phy/phy.c
index 5b04c85939040c27b832194a32f171686d6b88f6..df7e9450c2614a4040ced79d12d0e21238e5f689 100644 (file)
--- a/drivers/net/phy/phy.c
+++ b/drivers/net/phy/phy.c
@@ -442,6 +442,9 @@ static LIST_HEAD(phy_drivers);
 
 int phy_init(void)
 {
+#ifdef CONFIG_PHY_AQUANTIA
+       phy_aquantia_init();
+#endif
 #ifdef CONFIG_PHY_ATHEROS
        phy_atheros_init();
 #endif

diff --git a/include/phy.h b/include/phy.h
index 1e282e2964ec44e5b24fd22b0febd5200dc0df88..d117fc1634b071a6da4bd90206619840618c0dcf 100644 (file)
--- a/include/phy.h
+++ b/include/phy.h
@@ -225,6 +225,7 @@ int gen10g_startup(struct phy_device *phydev);
 int gen10g_shutdown(struct phy_device *phydev);
 int gen10g_discover_mmds(struct phy_device *phydev);
 
+int phy_aquantia_init(void);
 int phy_atheros_init(void);
 int phy_broadcom_init(void);
 int phy_cortina_init(void);