Merge branch 'master' of git://www.denx.de/git/u-boot-imx

[u-boot] / drivers / net / phy / realtek.c

diff --git a/drivers/net/phy/realtek.c b/drivers/net/phy/realtek.c
index 2e152c9a036ca0d6f893f13082e63fc88ab8d06f..bba48da4099fda91558008d77e19bf373cfc7341 100644 (file)
--- a/drivers/net/phy/realtek.c
+++ b/drivers/net/phy/realtek.c
@@ -40,6 +40,8 @@
 #define MIIM_RTL8211F_PHYSTAT_LINK     0x0004
 
 #define MIIM_RTL8211F_PAGE_SELECT      0x1f
+#define MIIM_RTL8211F_TX_DELAY         0x100
+#define MIIM_RTL8211F_LCR              0x10
 
 /* RealTek RTL8211x */
 static int rtl8211x_config(struct phy_device *phydev)
@@ -60,6 +62,36 @@ static int rtl8211x_config(struct phy_device *phydev)
        return 0;
 }
 
+static int rtl8211f_config(struct phy_device *phydev)
+{
+       u16 reg;
+
+       phy_write(phydev, MDIO_DEVAD_NONE, MII_BMCR, BMCR_RESET);
+
+       if (phydev->interface == PHY_INTERFACE_MODE_RGMII) {
+               /* enable TXDLY */
+               phy_write(phydev, MDIO_DEVAD_NONE,
+                         MIIM_RTL8211F_PAGE_SELECT, 0xd08);
+               reg = phy_read(phydev, MDIO_DEVAD_NONE, 0x11);
+               reg |= MIIM_RTL8211F_TX_DELAY;
+               phy_write(phydev, MDIO_DEVAD_NONE, 0x11, reg);
+               /* restore to default page 0 */
+               phy_write(phydev, MDIO_DEVAD_NONE,
+                         MIIM_RTL8211F_PAGE_SELECT, 0x0);
+       }
+
+       /* Set green LED for Link, yellow LED for Active */
+       phy_write(phydev, MDIO_DEVAD_NONE,
+                 MIIM_RTL8211F_PAGE_SELECT, 0xd04);
+       phy_write(phydev, MDIO_DEVAD_NONE, 0x10, 0x617f);
+       phy_write(phydev, MDIO_DEVAD_NONE,
+                 MIIM_RTL8211F_PAGE_SELECT, 0x0);
+
+       genphy_config_aneg(phydev);
+
+       return 0;
+}
+
 static int rtl8211x_parse_status(struct phy_device *phydev)
 {
        unsigned int speed;
@@ -159,13 +191,6 @@ static int rtl8211f_parse_status(struct phy_device *phydev)
                phydev->speed = SPEED_10;
        }
 
-       if (phydev->interface == PHY_INTERFACE_MODE_RGMII) {
-               /* enable TXDLY */
-               phy_write(phydev, MDIO_DEVAD_NONE,
-                         MIIM_RTL8211F_PAGE_SELECT, 0xd08);
-               phy_write(phydev, MDIO_DEVAD_NONE, 0x11, 0x109);
-       }
-
        return 0;
 }
 
@@ -226,7 +251,7 @@ static struct phy_driver RTL8211F_driver = {
        .uid = 0x1cc916,
        .mask = 0xffffff,
        .features = PHY_GBIT_FEATURES,
-       .config = &rtl8211x_config,
+       .config = &rtl8211f_config,
        .startup = &rtl8211f_startup,
        .shutdown = &genphy_shutdown,
 };