/******************************************************************** * OK335xS LAN8710 phy driver hacking * 说明： * 本文主要是对OK335xS中的phy的驱动进行代码跟踪，并解决当前遇到 * LAN8710上电后插入网线，会导致LAN8710无法自动握手，Link灯不亮，内核 * 也检测不到LAN8710有状态发生了改变，最终问题定位于LAN8710的驱动初 * 始化部分，本文解决办法选择注释掉对应的内容就行了。 * * 2016-3-3 深圳 南山平山村 曾剑锋 *******************************************************************/ 一、make menuconfig 配置： .config - Linux/arm 3.2.0 Kernel Configuration ────────────────────────────────────────────────────────────────────────────── ┌───────────────── PHY Device support and infrastructure ─────────────────┐ │ Arrow keys navigate the menu. <Enter> selects submenus --->. │ │ Highlighted letters are hotkeys. Pressing <Y> includes, <N> excludes, │ │ <M> modularizes features. Press <Esc><Esc> to exit, <?> for Help, </> │ │ for Search. Legend: [*] built-in [ ] excluded <M> module < > │ │ ┌────^(-)─────────────────────────────────────────────────────────────┐ │ │ │ < > Drivers for Davicom PHYs │ │ │ │ < > Drivers for Quality Semiconductor PHYs │ │ │ │ < > Drivers for the Intel LXT PHYs │ │ │ │ < > Drivers for the Cicada PHYs │ │ │ │ < > Drivers for the Vitesse PHYs │ │ │ │ <*> Drivers for SMSC PHYs │ │ │ │ < > Drivers for Broadcom PHYs │ │ │ │ < > Drivers for ICPlus PHYs │ │ │ │ < > Drivers for Realtek PHYs │ │ │ │ < > Drivers for National Semiconductor PHYs │ │ │ └────v(+)─────────────────────────────────────────────────────────────┘ │ ├─────────────────────────────────────────────────────────────────────────┤ │ <Select> < Exit > < Help > │ └─────────────────────────────────────────────────────────────────────────┘ 二、linux-3.2.0/drivers/net/phy/smsc.c 跟踪： static struct phy_driver lan8710_driver = { <---------+ /* OUI=0x00800f, Model#=0x0f */ | .phy_id = 0x0007c0f0, | // mask导致phy_id=0x0007c0f1也行的 | .phy_id_mask = 0xfffffff0, | .name = "SMSC LAN8710/LAN8720", | | .features = (PHY_BASIC_FEATURES | SUPPORTED_Pause | | SUPPORTED_Asym_Pause), | .flags = PHY_HAS_INTERRUPT | PHY_HAS_MAGICANEG, | | /* basic functions */ | .config_aneg = genphy_config_aneg, --------*------+ .read_status = genphy_read_status, --------*------*--+ .config_init = smsc_phy_config_init, --------*------*--*-+ | | | | /* IRQ related */ | | | | .ack_interrupt = smsc_phy_ack_interrupt, | | | | .config_intr = smsc_phy_config_intr, | | | | | | | | .suspend = genphy_suspend, | | | | .resume = genphy_resume, | | | | | | | | .driver = { .owner = THIS_MODULE, } | | | | }; | | | | | | | | static int __init smsc_init(void) <---------+ | | | | { | | | | | int ret; | | | | | | | | | | ret = phy_driver_register (&lan83c185_driver); | | | | | if (ret) | | | | | goto err1; | | | | | | | | | | ret = phy_driver_register (&lan8187_driver); | | | | | if (ret) | | | | | goto err2; | | | | | | | | | | ret = phy_driver_register (&lan8700_driver); | | | | | if (ret) | | | | | goto err3; | | | | | | | | | | ret = phy_driver_register (&lan911x_int_driver);| | | | | if (ret) | | | | | goto err4; | | | | | | | | | | ret = phy_driver_register (&lan8710_driver); | -----+ | | | if (ret) | | | | goto err5; | | | | | | | | return 0; | | | | err5: | | | | phy_driver_unregister (&lan911x_int_driver); | | | | err4: | | | | phy_driver_unregister (&lan8700_driver); | | | | err3: | | | | phy_driver_unregister (&lan8187_driver); | | | | err2: | | | | phy_driver_unregister (&lan83c185_driver); | | | | err1: | | | | return ret; | | | | } | | | | | | | | static void __exit smsc_exit(void) | | | | { | | | | phy_driver_unregister (&lan8710_driver); | | | | phy_driver_unregister (&lan911x_int_driver); | | | | phy_driver_unregister (&lan8700_driver); | | | | phy_driver_unregister (&lan8187_driver); | | | | phy_driver_unregister (&lan83c185_driver); | | | | } | | | | | | | | MODULE_DESCRIPTION("SMSC PHY driver"); | | | | MODULE_AUTHOR("Herbert Valerio Riedel"); | | | | MODULE_LICENSE("GPL"); | | | | | | | | module_init(smsc_init); -----------+ | | | module_exit(smsc_exit); | | | | | | static struct mdio_device_id __maybe_unused smsc_tbl[] = { | | | { 0x0007c0a0, 0xfffffff0 }, | | | { 0x0007c0b0, 0xfffffff0 }, | | | { 0x0007c0c0, 0xfffffff0 }, | | | { 0x0007c0d0, 0xfffffff0 }, | | | { 0x0007c0f0, 0xfffffff0 }, | | | { } | | | }; | | | | | | MODULE_DEVICE_TABLE(mdio, smsc_tbl); | | | | | | | | | | | | static int __init phy_init(void) | | | { | | | int rc; | | | | | | rc = mdio_bus_init(); ------------------+ | | | if (rc) | | | | return rc; | | | | | | | | rc = phy_driver_register(&genphy_driver); ---*-----+ | | | if (rc) | | | | | mdio_bus_exit(); | | | | | | | | | | return rc; | | | | | } | | | | | | | | | | static void __exit phy_exit(void) | | | | | { | | | | | phy_driver_unregister(&genphy_driver); | | | | | mdio_bus_exit(); | | | | | } | | | | | | | | | | subsys_initcall(phy_init); | | | | | module_exit(phy_exit); | | | | | | | | | | struct bus_type mdio_bus_type = { <-------+ | | | | | .name = "mdio_bus", | | | | | | .match = mdio_bus_match, ------*-*-+ | | | | .pm = MDIO_BUS_PM_OPS, | | | | | | | }; | | | | | | | EXPORT_SYMBOL(mdio_bus_type); | | | | | | | | | | | | | | int __init mdio_bus_init(void) <-----------*-+ | | | | | { | | | | | | int ret; | | | | | | | | | | | | ret = class_register(&mdio_bus_class); | | | | | | if (!ret) { | | | | | | ret = bus_register(&mdio_bus_type); -----+ | | | | | if (ret) | | | | | class_unregister(&mdio_bus_class); | | | | | } | | | | | | | | | | return ret; | | | | | } | | | | | | | | | | void mdio_bus_exit(void) | | | | | { | | | | | class_unregister(&mdio_bus_class); | | | | | bus_unregister(&mdio_bus_type); | | | | | } | | | | | | | | | | static int mdio_bus_match(struct device *dev, <-----+ | | | | struct device_driver *drv) | | | | { | | | | struct phy_device *phydev = to_phy_device(dev); | | | | struct phy_driver *phydrv = to_phy_driver(drv); | | | | | | | | return ((phydrv->phy_id & phydrv->phy_id_mask) == | | | | (phydev->phy_id & phydrv->phy_id_mask)); | | | | } | | | | | | | | static struct phy_driver genphy_driver = { <---------+ | | | .phy_id = 0xffffffff, | | | | .phy_id_mask = 0xffffffff, | | | | .name = "Generic PHY", | | | | .config_init = genphy_config_init, ------*-------+ | | | .features = 0, | | | | | .config_aneg = genphy_config_aneg, ------*-------*-+ | | .read_status = genphy_read_status, ------*-------*-*--+ | .suspend = genphy_suspend, | | | | | .resume = genphy_resume, | | | | | .driver = {.owner= THIS_MODULE, }, | | | | | }; | | | | | | | | | | int phy_driver_register(struct phy_driver *new_driver) <--+ | | | | { | | | | int retval; | | | | | | | | new_driver->driver.name = new_driver->name; | | | | new_driver->driver.bus = &mdio_bus_type; | | | | new_driver->driver.probe = phy_probe; -----------+ | | | | new_driver->driver.remove = phy_remove; | | | | | | | | | | retval = driver_register(&new_driver->driver); | | | | | | | | | | if (retval) { | | | | | printk(KERN_ERR "%s: Error %d in registering driver\n", | | | | | new_driver->name, retval); | | | | | | | | | | return retval; | | | | | } | | | | | | | | | | pr_debug("%s: Registered new driver\n", new_driver->name); | | | | | | | | | | return 0; | | | | | } | | | | | EXPORT_SYMBOL(phy_driver_register); | | | | | | | | | | static int phy_probe(struct device *dev) <-----------+ | | | | { | | | | struct phy_device *phydev; | | | | struct phy_driver *phydrv; | | | | struct device_driver *drv; | | | | int err = 0; | | | | | | | | phydev = to_phy_device(dev); | | | | | | | | /* Make sure the driver is held. | | | | * XXX -- Is this correct? */ | | | | drv = get_driver(phydev->dev.driver); | | | | phydrv = to_phy_driver(drv); | | | | phydev->drv = phydrv; | | | | | | | | /* Disable the interrupt if the PHY doesn't support it */ | | | | if (!(phydrv->flags & PHY_HAS_INTERRUPT)) | | | | phydev->irq = PHY_POLL; | | | | | | | | mutex_lock(&phydev->lock); | | | | | | | | /* Start out supporting everything. Eventually, | | | | * a controller will attach, and may modify one | | | | * or both of these values */ | | | | phydev->supported = phydrv->features; | | | | phydev->advertising = phydrv->features; | | | | | | | | | | | | /* Set the state to READY by default */ | | | | phydev->state = PHY_READY; | | | | | | | | if (phydev->drv->probe) | | | | err = phydev->drv->probe(phydev); | | | | | | | | mutex_unlock(&phydev->lock); | | | | | | | | return err; | | | | | | | | } | | | | | | | | static int genphy_config_init(struct phy_device *phydev) <-------+ | | | { | | | int val; | | | u32 features; | | | | | | /* For now, I'll claim that the generic driver supports | | | * all possible port types */ | | | features = (SUPPORTED_TP | SUPPORTED_MII | | | | SUPPORTED_AUI | SUPPORTED_FIBRE | | | | SUPPORTED_BNC); | | | | | | /* Do we support autonegotiation? */ | | | val = phy_read(phydev, MII_BMSR); | | | | | | if (val < 0) | | | return val; | | | | | | if (val & BMSR_ANEGCAPABLE) | | | features |= SUPPORTED_Autoneg; | | | | | | if (val & BMSR_100FULL) | | | features |= SUPPORTED_100baseT_Full; | | | if (val & BMSR_100HALF) | | | features |= SUPPORTED_100baseT_Half; | | | if (val & BMSR_10FULL) | | | features |= SUPPORTED_10baseT_Full; | | | if (val & BMSR_10HALF) | | | features |= SUPPORTED_10baseT_Half; | | | | | | if (val & BMSR_ESTATEN) { | | | val = phy_read(phydev, MII_ESTATUS); | | | | | | if (val < 0) | | | return val; | | | | | | if (val & ESTATUS_1000_TFULL) | | | features |= SUPPORTED_1000baseT_Full; | | | if (val & ESTATUS_1000_THALF) | | | features |= SUPPORTED_1000baseT_Half; | | | } | | | | | | phydev->supported = features; | | | phydev->advertising = features; | | | | | | return 0; | | | } | | | | | | int genphy_config_aneg(struct phy_device *phydev) <----------+ | | { | | int result; | | | | printk("zengjf check postion at %s.\n", __func__); | | | | if (AUTONEG_ENABLE != phydev->autoneg) | | return genphy_setup_forced(phydev); | | | | result = genphy_config_advert(phydev); | | | | if (result < 0) /* error */ | | return result; | | | | if (result == 0) { | | /* Advertisement hasn't changed, but maybe aneg was never on to| | * begin with? Or maybe phy was isolated? */ | | int ctl = phy_read(phydev, MII_BMCR); | | | | if (ctl < 0) | | return ctl; | | | | if (!(ctl & BMCR_ANENABLE) || (ctl & BMCR_ISOLATE)) | | result = 1; /* do restart aneg */ | | } | | | | /* Only restart aneg if we are advertising something different | | * than we were before. */ | | if (result > 0) | | result = genphy_restart_aneg(phydev); | | | | return result; | | } | | EXPORT_SYMBOL(genphy_config_aneg); | | | | int genphy_read_status(struct phy_device *phydev) <----------+ | { | int adv; | int err; | int lpa; | int lpagb = 0; | | /* Update the link, but return if there | * was an error */ | err = genphy_update_link(phydev); | if (err) | return err; | | if (AUTONEG_ENABLE == phydev->autoneg) { | if (phydev->supported & (SUPPORTED_1000baseT_Half | | SUPPORTED_1000baseT_Full)) { | lpagb = phy_read(phydev, MII_STAT1000); | | if (lpagb < 0) | return lpagb; | | adv = phy_read(phydev, MII_CTRL1000); | | if (adv < 0) | return adv; | | lpagb &= adv << 2; | } | | lpa = phy_read(phydev, MII_LPA); | | if (lpa < 0) | return lpa; | | adv = phy_read(phydev, MII_ADVERTISE); | | if (adv < 0) | return adv; | | lpa &= adv; | | phydev->speed = SPEED_10; | phydev->duplex = DUPLEX_HALF; | phydev->pause = phydev->asym_pause = 0; | | if (lpagb & (LPA_1000FULL | LPA_1000HALF)) { | phydev->speed = SPEED_1000; | | if (lpagb & LPA_1000FULL) | phydev->duplex = DUPLEX_FULL; | } else if (lpa & (LPA_100FULL | LPA_100HALF)) { | phydev->speed = SPEED_100; | | if (lpa & LPA_100FULL) | phydev->duplex = DUPLEX_FULL; | } else | if (lpa & LPA_10FULL) | phydev->duplex = DUPLEX_FULL; | | if (phydev->duplex == DUPLEX_FULL){ | phydev->pause = lpa & LPA_PAUSE_CAP ? 1 : 0; | phydev->asym_pause = lpa & LPA_PAUSE_ASYM ? 1 : 0; | } | } else { | int bmcr = phy_read(phydev, MII_BMCR); | if (bmcr < 0) | return bmcr; | | if (bmcr & BMCR_FULLDPLX) | phydev->duplex = DUPLEX_FULL; | else | phydev->duplex = DUPLEX_HALF; | | if (bmcr & BMCR_SPEED1000) | phydev->speed = SPEED_1000; | else if (bmcr & BMCR_SPEED100) | phydev->speed = SPEED_100; | else | phydev->speed = SPEED_10; | | phydev->pause = phydev->asym_pause = 0; | } | | return 0; | } | EXPORT_SYMBOL(genphy_read_status); | | | static int smsc_phy_config_init(struct phy_device *phydev) <---------+ { printk("zengjf check position %s.\n", __func__); #if 0 // 这段代码会导致PHY无法自动识别到网线插入 int rc = phy_read(phydev, MII_LAN83C185_CTRL_STATUS); if (rc < 0) return rc; /* Enable energy detect mode for this SMSC Transceivers */ rc = phy_write(phydev, MII_LAN83C185_CTRL_STATUS, rc | MII_LAN83C185_EDPWRDOWN); if (rc < 0) return rc; #endif return smsc_phy_ack_interrupt (phydev); }
