1 /* 2 * RealTek PHY drivers 3 * 4 * SPDX-License-Identifier: GPL-2.0+ 5 * 6 * Copyright 2010-2011 Freescale Semiconductor, Inc. 7 * author Andy Fleming 8 */ 9 #include <config.h> 10 #include <common.h> 11 #include <phy.h> 12 13 #define PHY_AUTONEGOTIATE_TIMEOUT 5000 14 15 /* RTL8211B PHY Status Register */ 16 #define MIIM_RTL8211B_PHY_STATUS 0x11 17 #define MIIM_RTL8211B_PHYSTAT_SPEED 0xc000 18 #define MIIM_RTL8211B_PHYSTAT_GBIT 0x8000 19 #define MIIM_RTL8211B_PHYSTAT_100 0x4000 20 #define MIIM_RTL8211B_PHYSTAT_DUPLEX 0x2000 21 #define MIIM_RTL8211B_PHYSTAT_SPDDONE 0x0800 22 #define MIIM_RTL8211B_PHYSTAT_LINK 0x0400 23 24 25 /* RealTek RTL8211B */ 26 static int rtl8211b_config(struct phy_device *phydev) 27 { 28 phy_write(phydev, MDIO_DEVAD_NONE, MII_BMCR, BMCR_RESET); 29 30 genphy_config_aneg(phydev); 31 32 return 0; 33 } 34 35 static int rtl8211b_parse_status(struct phy_device *phydev) 36 { 37 unsigned int speed; 38 unsigned int mii_reg; 39 40 mii_reg = phy_read(phydev, MDIO_DEVAD_NONE, MIIM_RTL8211B_PHY_STATUS); 41 42 if (!(mii_reg & MIIM_RTL8211B_PHYSTAT_SPDDONE)) { 43 int i = 0; 44 45 /* in case of timeout ->link is cleared */ 46 phydev->link = 1; 47 puts("Waiting for PHY realtime link"); 48 while (!(mii_reg & MIIM_RTL8211B_PHYSTAT_SPDDONE)) { 49 /* Timeout reached ? */ 50 if (i > PHY_AUTONEGOTIATE_TIMEOUT) { 51 puts(" TIMEOUT !\n"); 52 phydev->link = 0; 53 break; 54 } 55 56 if ((i++ % 1000) == 0) 57 putc('.'); 58 udelay(1000); /* 1 ms */ 59 mii_reg = phy_read(phydev, MDIO_DEVAD_NONE, 60 MIIM_RTL8211B_PHY_STATUS); 61 } 62 puts(" done\n"); 63 udelay(500000); /* another 500 ms (results in faster booting) */ 64 } else { 65 if (mii_reg & MIIM_RTL8211B_PHYSTAT_LINK) 66 phydev->link = 1; 67 else 68 phydev->link = 0; 69 } 70 71 if (mii_reg & MIIM_RTL8211B_PHYSTAT_DUPLEX) 72 phydev->duplex = DUPLEX_FULL; 73 else 74 phydev->duplex = DUPLEX_HALF; 75 76 speed = (mii_reg & MIIM_RTL8211B_PHYSTAT_SPEED); 77 78 switch (speed) { 79 case MIIM_RTL8211B_PHYSTAT_GBIT: 80 phydev->speed = SPEED_1000; 81 break; 82 case MIIM_RTL8211B_PHYSTAT_100: 83 phydev->speed = SPEED_100; 84 break; 85 default: 86 phydev->speed = SPEED_10; 87 } 88 89 return 0; 90 } 91 92 static int rtl8211b_startup(struct phy_device *phydev) 93 { 94 /* Read the Status (2x to make sure link is right) */ 95 genphy_update_link(phydev); 96 rtl8211b_parse_status(phydev); 97 98 return 0; 99 } 100 101 static struct phy_driver RTL8211B_driver = { 102 .name = "RealTek RTL8211B", 103 .uid = 0x1cc910, 104 .mask = 0xfffff0, 105 .features = PHY_GBIT_FEATURES, 106 .config = &rtl8211b_config, 107 .startup = &rtl8211b_startup, 108 .shutdown = &genphy_shutdown, 109 }; 110 111 int phy_realtek_init(void) 112 { 113 phy_register(&RTL8211B_driver); 114 115 return 0; 116 } 117