Lines Matching refs:phydev
202 void phy_device_free(struct phy_device *phydev) in phy_device_free() argument
204 put_device(&phydev->mdio.dev); in phy_device_free()
210 struct phy_device *phydev; in phy_mdio_device_free() local
212 phydev = container_of(mdiodev, struct phy_device, mdio); in phy_mdio_device_free()
213 phy_device_free(phydev); in phy_mdio_device_free()
223 struct phy_device *phydev; in phy_mdio_device_remove() local
225 phydev = container_of(mdiodev, struct phy_device, mdio); in phy_mdio_device_remove()
226 phy_device_remove(phydev); in phy_mdio_device_remove()
234 static bool mdio_bus_phy_may_suspend(struct phy_device *phydev) in mdio_bus_phy_may_suspend() argument
236 struct device_driver *drv = phydev->mdio.dev.driver; in mdio_bus_phy_may_suspend()
238 struct net_device *netdev = phydev->attached_dev; in mdio_bus_phy_may_suspend()
270 return !phydev->suspended; in mdio_bus_phy_may_suspend()
275 struct phy_device *phydev = to_phy_device(dev); in mdio_bus_phy_suspend() local
277 if (phydev->mac_managed_pm) in mdio_bus_phy_suspend()
285 if (phydev->attached_dev && phydev->adjust_link) in mdio_bus_phy_suspend()
286 phy_stop_machine(phydev); in mdio_bus_phy_suspend()
288 if (!mdio_bus_phy_may_suspend(phydev)) in mdio_bus_phy_suspend()
291 phydev->suspended_by_mdio_bus = 1; in mdio_bus_phy_suspend()
293 return phy_suspend(phydev); in mdio_bus_phy_suspend()
298 struct phy_device *phydev = to_phy_device(dev); in mdio_bus_phy_resume() local
301 if (phydev->mac_managed_pm) in mdio_bus_phy_resume()
304 if (!phydev->suspended_by_mdio_bus) in mdio_bus_phy_resume()
307 phydev->suspended_by_mdio_bus = 0; in mdio_bus_phy_resume()
309 ret = phy_init_hw(phydev); in mdio_bus_phy_resume()
313 ret = phy_resume(phydev); in mdio_bus_phy_resume()
317 if (phydev->attached_dev && phydev->adjust_link) in mdio_bus_phy_resume()
318 phy_start_machine(phydev); in mdio_bus_phy_resume()
422 static int phy_needs_fixup(struct phy_device *phydev, struct phy_fixup *fixup) in phy_needs_fixup() argument
424 if (strcmp(fixup->bus_id, phydev_name(phydev)) != 0) in phy_needs_fixup()
429 (phydev->phy_id & fixup->phy_uid_mask)) in phy_needs_fixup()
437 static int phy_scan_fixups(struct phy_device *phydev) in phy_scan_fixups() argument
443 if (phy_needs_fixup(phydev, fixup)) { in phy_scan_fixups()
444 int err = fixup->run(phydev); in phy_scan_fixups()
450 phydev->has_fixups = true; in phy_scan_fixups()
460 struct phy_device *phydev = to_phy_device(dev); in phy_bus_match() local
462 const int num_ids = ARRAY_SIZE(phydev->c45_ids.device_ids); in phy_bus_match()
469 return phydrv->match_phy_device(phydev); in phy_bus_match()
471 if (phydev->is_c45) { in phy_bus_match()
473 if (phydev->c45_ids.device_ids[i] == 0xffffffff) in phy_bus_match()
477 (phydev->c45_ids.device_ids[i] & in phy_bus_match()
484 (phydev->phy_id & phydrv->phy_id_mask); in phy_bus_match()
491 struct phy_device *phydev = to_phy_device(dev); in phy_id_show() local
493 return sprintf(buf, "0x%.8lx\n", (unsigned long)phydev->phy_id); in phy_id_show()
500 struct phy_device *phydev = to_phy_device(dev); in phy_interface_show() local
503 if (phy_is_internal(phydev)) in phy_interface_show()
506 mode = phy_modes(phydev->interface); in phy_interface_show()
516 struct phy_device *phydev = to_phy_device(dev); in phy_has_fixups_show() local
518 return sprintf(buf, "%d\n", phydev->has_fixups); in phy_has_fixups_show()
526 struct phy_device *phydev = to_phy_device(dev); in phy_dev_flags_show() local
528 return sprintf(buf, "0x%08x\n", phydev->dev_flags); in phy_dev_flags_show()
915 int phy_device_register(struct phy_device *phydev) in phy_device_register() argument
919 err = mdiobus_register_device(&phydev->mdio); in phy_device_register()
924 phy_device_reset(phydev, 0); in phy_device_register()
927 err = phy_scan_fixups(phydev); in phy_device_register()
929 phydev_err(phydev, "failed to initialize\n"); in phy_device_register()
933 err = device_add(&phydev->mdio.dev); in phy_device_register()
935 phydev_err(phydev, "failed to add\n"); in phy_device_register()
943 phy_device_reset(phydev, 1); in phy_device_register()
945 mdiobus_unregister_device(&phydev->mdio); in phy_device_register()
958 void phy_device_remove(struct phy_device *phydev) in phy_device_remove() argument
960 unregister_mii_timestamper(phydev->mii_ts); in phy_device_remove()
962 device_del(&phydev->mdio.dev); in phy_device_remove()
965 phy_device_reset(phydev, 1); in phy_device_remove()
967 mdiobus_unregister_device(&phydev->mdio); in phy_device_remove()
978 int phy_get_c45_ids(struct phy_device *phydev) in phy_get_c45_ids() argument
980 return get_phy_c45_ids(phydev->mdio.bus, phydev->mdio.addr, in phy_get_c45_ids()
981 &phydev->c45_ids); in phy_get_c45_ids()
991 struct phy_device *phydev; in phy_find_first() local
995 phydev = mdiobus_get_phy(bus, addr); in phy_find_first()
996 if (phydev) in phy_find_first()
997 return phydev; in phy_find_first()
1003 static void phy_link_change(struct phy_device *phydev, bool up) in phy_link_change() argument
1005 struct net_device *netdev = phydev->attached_dev; in phy_link_change()
1011 phydev->adjust_link(netdev); in phy_link_change()
1012 if (phydev->mii_ts && phydev->mii_ts->link_state) in phy_link_change()
1013 phydev->mii_ts->link_state(phydev->mii_ts, phydev); in phy_link_change()
1028 static void phy_prepare_link(struct phy_device *phydev, in phy_prepare_link() argument
1031 phydev->adjust_link = handler; in phy_prepare_link()
1041 int phy_connect_direct(struct net_device *dev, struct phy_device *phydev, in phy_connect_direct() argument
1050 rc = phy_attach_direct(dev, phydev, phydev->dev_flags, interface); in phy_connect_direct()
1054 phy_prepare_link(phydev, handler); in phy_connect_direct()
1055 if (phy_interrupt_is_valid(phydev)) in phy_connect_direct()
1056 phy_request_interrupt(phydev); in phy_connect_direct()
1081 struct phy_device *phydev; in phy_connect() local
1093 phydev = to_phy_device(d); in phy_connect()
1095 rc = phy_connect_direct(dev, phydev, handler, interface); in phy_connect()
1100 return phydev; in phy_connect()
1109 void phy_disconnect(struct phy_device *phydev) in phy_disconnect() argument
1111 if (phy_is_started(phydev)) in phy_disconnect()
1112 phy_stop(phydev); in phy_disconnect()
1114 if (phy_interrupt_is_valid(phydev)) in phy_disconnect()
1115 phy_free_interrupt(phydev); in phy_disconnect()
1117 phydev->adjust_link = NULL; in phy_disconnect()
1119 phy_detach(phydev); in phy_disconnect()
1141 static int phy_poll_reset(struct phy_device *phydev) in phy_poll_reset() argument
1146 ret = phy_read_poll_timeout(phydev, MII_BMCR, val, !(val & BMCR_RESET), in phy_poll_reset()
1157 int phy_init_hw(struct phy_device *phydev) in phy_init_hw() argument
1162 phy_device_reset(phydev, 0); in phy_init_hw()
1164 if (!phydev->drv) in phy_init_hw()
1167 if (phydev->drv->soft_reset) { in phy_init_hw()
1168 ret = phydev->drv->soft_reset(phydev); in phy_init_hw()
1171 phydev->suspended = 0; in phy_init_hw()
1177 ret = phy_scan_fixups(phydev); in phy_init_hw()
1181 if (phydev->drv->config_init) { in phy_init_hw()
1182 ret = phydev->drv->config_init(phydev); in phy_init_hw()
1187 if (phydev->drv->config_intr) { in phy_init_hw()
1188 ret = phydev->drv->config_intr(phydev); in phy_init_hw()
1197 void phy_attached_info(struct phy_device *phydev) in phy_attached_info() argument
1199 phy_attached_print(phydev, NULL); in phy_attached_info()
1204 char *phy_attached_info_irq(struct phy_device *phydev) in phy_attached_info_irq() argument
1209 switch(phydev->irq) { in phy_attached_info_irq()
1217 snprintf(irq_num, sizeof(irq_num), "%d", phydev->irq); in phy_attached_info_irq()
1226 void phy_attached_print(struct phy_device *phydev, const char *fmt, ...) in phy_attached_print() argument
1228 const char *unbound = phydev->drv ? "" : "[unbound] "; in phy_attached_print()
1229 char *irq_str = phy_attached_info_irq(phydev); in phy_attached_print()
1232 phydev_info(phydev, ATTACHED_FMT "\n", unbound, in phy_attached_print()
1233 phydev_name(phydev), irq_str); in phy_attached_print()
1237 phydev_info(phydev, ATTACHED_FMT, unbound, in phy_attached_print()
1238 phydev_name(phydev), irq_str); in phy_attached_print()
1248 static void phy_sysfs_create_links(struct phy_device *phydev) in phy_sysfs_create_links() argument
1250 struct net_device *dev = phydev->attached_dev; in phy_sysfs_create_links()
1256 err = sysfs_create_link(&phydev->mdio.dev.kobj, &dev->dev.kobj, in phy_sysfs_create_links()
1262 &phydev->mdio.dev.kobj, in phy_sysfs_create_links()
1266 kobject_name(&phydev->mdio.dev.kobj), in phy_sysfs_create_links()
1273 phydev->sysfs_links = true; in phy_sysfs_create_links()
1280 struct phy_device *phydev = to_phy_device(dev); in phy_standalone_show() local
1282 return sprintf(buf, "%d\n", !phydev->attached_dev); in phy_standalone_show()
1295 struct phy_device *phydev = upstream; in phy_sfp_attach() local
1297 if (phydev->attached_dev) in phy_sfp_attach()
1298 phydev->attached_dev->sfp_bus = bus; in phy_sfp_attach()
1299 phydev->sfp_bus_attached = true; in phy_sfp_attach()
1312 struct phy_device *phydev = upstream; in phy_sfp_detach() local
1314 if (phydev->attached_dev) in phy_sfp_detach()
1315 phydev->attached_dev->sfp_bus = NULL; in phy_sfp_detach()
1316 phydev->sfp_bus_attached = false; in phy_sfp_detach()
1325 int phy_sfp_probe(struct phy_device *phydev, in phy_sfp_probe() argument
1331 if (phydev->mdio.dev.fwnode) { in phy_sfp_probe()
1332 bus = sfp_bus_find_fwnode(phydev->mdio.dev.fwnode); in phy_sfp_probe()
1336 phydev->sfp_bus = bus; in phy_sfp_probe()
1338 ret = sfp_bus_add_upstream(bus, phydev, ops); in phy_sfp_probe()
1360 int phy_attach_direct(struct net_device *dev, struct phy_device *phydev, in phy_attach_direct() argument
1363 struct mii_bus *bus = phydev->mdio.bus; in phy_attach_direct()
1364 struct device *d = &phydev->mdio.dev; in phy_attach_direct()
1377 phydev_err(phydev, "failed to get the bus module\n"); in phy_attach_direct()
1387 if (phydev->is_c45) in phy_attach_direct()
1396 phydev_err(phydev, "failed to get the device driver module\n"); in phy_attach_direct()
1410 if (phydev->attached_dev) { in phy_attach_direct()
1416 phydev->phy_link_change = phy_link_change; in phy_attach_direct()
1418 phydev->attached_dev = dev; in phy_attach_direct()
1419 dev->phydev = phydev; in phy_attach_direct()
1421 if (phydev->sfp_bus_attached) in phy_attach_direct()
1422 dev->sfp_bus = phydev->sfp_bus; in phy_attach_direct()
1424 phydev->is_on_sfp_module = true; in phy_attach_direct()
1435 phydev->sysfs_links = false; in phy_attach_direct()
1437 phy_sysfs_create_links(phydev); in phy_attach_direct()
1439 if (!phydev->attached_dev) { in phy_attach_direct()
1440 err = sysfs_create_file(&phydev->mdio.dev.kobj, in phy_attach_direct()
1443 phydev_err(phydev, "error creating 'phy_standalone' sysfs entry\n"); in phy_attach_direct()
1446 phydev->dev_flags |= flags; in phy_attach_direct()
1448 phydev->interface = interface; in phy_attach_direct()
1450 phydev->state = PHY_READY; in phy_attach_direct()
1458 phydev->port = PORT_MII; in phy_attach_direct()
1464 netif_carrier_off(phydev->attached_dev); in phy_attach_direct()
1470 err = phy_init_hw(phydev); in phy_attach_direct()
1474 err = phy_disable_interrupts(phydev); in phy_attach_direct()
1478 phy_resume(phydev); in phy_attach_direct()
1479 phy_led_triggers_register(phydev); in phy_attach_direct()
1485 phy_detach(phydev); in phy_attach_direct()
1511 struct phy_device *phydev; in phy_attach() local
1526 phydev = to_phy_device(d); in phy_attach()
1528 rc = phy_attach_direct(dev, phydev, phydev->dev_flags, interface); in phy_attach()
1533 return phydev; in phy_attach()
1537 static bool phy_driver_is_genphy_kind(struct phy_device *phydev, in phy_driver_is_genphy_kind() argument
1540 struct device *d = &phydev->mdio.dev; in phy_driver_is_genphy_kind()
1543 if (!phydev->drv) in phy_driver_is_genphy_kind()
1553 bool phy_driver_is_genphy(struct phy_device *phydev) in phy_driver_is_genphy() argument
1555 return phy_driver_is_genphy_kind(phydev, in phy_driver_is_genphy()
1560 bool phy_driver_is_genphy_10g(struct phy_device *phydev) in phy_driver_is_genphy_10g() argument
1562 return phy_driver_is_genphy_kind(phydev, in phy_driver_is_genphy_10g()
1593 int phy_package_join(struct phy_device *phydev, int addr, size_t priv_size) in phy_package_join() argument
1595 struct mii_bus *bus = phydev->mdio.bus; in phy_package_join()
1626 phydev->shared = shared; in phy_package_join()
1646 void phy_package_leave(struct phy_device *phydev) in phy_package_leave() argument
1648 struct phy_package_shared *shared = phydev->shared; in phy_package_leave()
1649 struct mii_bus *bus = phydev->mdio.bus; in phy_package_leave()
1661 phydev->shared = NULL; in phy_package_leave()
1681 int devm_phy_package_join(struct device *dev, struct phy_device *phydev, in devm_phy_package_join() argument
1692 ret = phy_package_join(phydev, addr, priv_size); in devm_phy_package_join()
1695 *ptr = phydev; in devm_phy_package_join()
1712 void phy_detach(struct phy_device *phydev) in phy_detach() argument
1714 struct net_device *dev = phydev->attached_dev; in phy_detach()
1718 if (phydev->sysfs_links) { in phy_detach()
1721 sysfs_remove_link(&phydev->mdio.dev.kobj, "attached_dev"); in phy_detach()
1724 if (!phydev->attached_dev) in phy_detach()
1725 sysfs_remove_file(&phydev->mdio.dev.kobj, in phy_detach()
1728 phy_suspend(phydev); in phy_detach()
1730 phydev->attached_dev->phydev = NULL; in phy_detach()
1731 phydev->attached_dev = NULL; in phy_detach()
1733 phydev->phylink = NULL; in phy_detach()
1735 phy_led_triggers_unregister(phydev); in phy_detach()
1737 if (phydev->mdio.dev.driver) in phy_detach()
1738 module_put(phydev->mdio.dev.driver->owner); in phy_detach()
1745 if (phy_driver_is_genphy(phydev) || in phy_detach()
1746 phy_driver_is_genphy_10g(phydev)) in phy_detach()
1747 device_release_driver(&phydev->mdio.dev); in phy_detach()
1753 bus = phydev->mdio.bus; in phy_detach()
1755 put_device(&phydev->mdio.dev); in phy_detach()
1762 phy_device_reset(phydev, 1); in phy_detach()
1766 int phy_suspend(struct phy_device *phydev) in phy_suspend() argument
1769 struct net_device *netdev = phydev->attached_dev; in phy_suspend()
1770 struct phy_driver *phydrv = phydev->drv; in phy_suspend()
1773 if (phydev->suspended) in phy_suspend()
1777 phy_ethtool_get_wol(phydev, &wol); in phy_suspend()
1784 ret = phydrv->suspend(phydev); in phy_suspend()
1786 phydev->suspended = true; in phy_suspend()
1792 int __phy_resume(struct phy_device *phydev) in __phy_resume() argument
1794 struct phy_driver *phydrv = phydev->drv; in __phy_resume()
1797 lockdep_assert_held(&phydev->lock); in __phy_resume()
1802 ret = phydrv->resume(phydev); in __phy_resume()
1804 phydev->suspended = false; in __phy_resume()
1810 int phy_resume(struct phy_device *phydev) in phy_resume() argument
1814 mutex_lock(&phydev->lock); in phy_resume()
1815 ret = __phy_resume(phydev); in phy_resume()
1816 mutex_unlock(&phydev->lock); in phy_resume()
1822 int phy_loopback(struct phy_device *phydev, bool enable) in phy_loopback() argument
1826 if (!phydev->drv) in phy_loopback()
1829 mutex_lock(&phydev->lock); in phy_loopback()
1831 if (enable && phydev->loopback_enabled) { in phy_loopback()
1836 if (!enable && !phydev->loopback_enabled) { in phy_loopback()
1841 if (phydev->drv->set_loopback) in phy_loopback()
1842 ret = phydev->drv->set_loopback(phydev, enable); in phy_loopback()
1844 ret = genphy_loopback(phydev, enable); in phy_loopback()
1849 phydev->loopback_enabled = enable; in phy_loopback()
1852 mutex_unlock(&phydev->lock); in phy_loopback()
1866 int phy_reset_after_clk_enable(struct phy_device *phydev) in phy_reset_after_clk_enable() argument
1868 if (!phydev || !phydev->drv) in phy_reset_after_clk_enable()
1871 if (phydev->drv->flags & PHY_RST_AFTER_CLK_EN) { in phy_reset_after_clk_enable()
1872 phy_device_reset(phydev, 1); in phy_reset_after_clk_enable()
1873 phy_device_reset(phydev, 0); in phy_reset_after_clk_enable()
1892 static int genphy_config_advert(struct phy_device *phydev) in genphy_config_advert() argument
1898 linkmode_and(phydev->advertising, phydev->advertising, in genphy_config_advert()
1899 phydev->supported); in genphy_config_advert()
1901 adv = linkmode_adv_to_mii_adv_t(phydev->advertising); in genphy_config_advert()
1904 err = phy_modify_changed(phydev, MII_ADVERTISE, in genphy_config_advert()
1913 bmsr = phy_read(phydev, MII_BMSR); in genphy_config_advert()
1924 adv = linkmode_adv_to_mii_ctrl1000_t(phydev->advertising); in genphy_config_advert()
1926 err = phy_modify_changed(phydev, MII_CTRL1000, in genphy_config_advert()
1947 static int genphy_c37_config_advert(struct phy_device *phydev) in genphy_c37_config_advert() argument
1952 linkmode_and(phydev->advertising, phydev->advertising, in genphy_c37_config_advert()
1953 phydev->supported); in genphy_c37_config_advert()
1956 phydev->advertising)) in genphy_c37_config_advert()
1959 phydev->advertising)) in genphy_c37_config_advert()
1962 phydev->advertising)) in genphy_c37_config_advert()
1965 return phy_modify_changed(phydev, MII_ADVERTISE, in genphy_c37_config_advert()
1979 int genphy_config_eee_advert(struct phy_device *phydev) in genphy_config_eee_advert() argument
1984 if (!phydev->eee_broken_modes) in genphy_config_eee_advert()
1987 err = phy_modify_mmd_changed(phydev, MDIO_MMD_AN, MDIO_AN_EEE_ADV, in genphy_config_eee_advert()
1988 phydev->eee_broken_modes, 0); in genphy_config_eee_advert()
2002 int genphy_setup_forced(struct phy_device *phydev) in genphy_setup_forced() argument
2006 phydev->pause = 0; in genphy_setup_forced()
2007 phydev->asym_pause = 0; in genphy_setup_forced()
2009 if (SPEED_1000 == phydev->speed) in genphy_setup_forced()
2011 else if (SPEED_100 == phydev->speed) in genphy_setup_forced()
2014 if (DUPLEX_FULL == phydev->duplex) in genphy_setup_forced()
2017 return phy_modify(phydev, MII_BMCR, in genphy_setup_forced()
2022 static int genphy_setup_master_slave(struct phy_device *phydev) in genphy_setup_master_slave() argument
2026 if (!phydev->is_gigabit_capable) in genphy_setup_master_slave()
2029 switch (phydev->master_slave_set) { in genphy_setup_master_slave()
2045 phydev_warn(phydev, "Unsupported Master/Slave mode\n"); in genphy_setup_master_slave()
2049 return phy_modify_changed(phydev, MII_CTRL1000, in genphy_setup_master_slave()
2054 static int genphy_read_master_slave(struct phy_device *phydev) in genphy_read_master_slave() argument
2059 if (!phydev->is_gigabit_capable) { in genphy_read_master_slave()
2060 phydev->master_slave_get = MASTER_SLAVE_CFG_UNSUPPORTED; in genphy_read_master_slave()
2061 phydev->master_slave_state = MASTER_SLAVE_STATE_UNSUPPORTED; in genphy_read_master_slave()
2065 phydev->master_slave_get = MASTER_SLAVE_CFG_UNKNOWN; in genphy_read_master_slave()
2066 phydev->master_slave_state = MASTER_SLAVE_STATE_UNKNOWN; in genphy_read_master_slave()
2068 val = phy_read(phydev, MII_CTRL1000); in genphy_read_master_slave()
2084 val = phy_read(phydev, MII_STAT1000); in genphy_read_master_slave()
2090 } else if (phydev->link) { in genphy_read_master_slave()
2100 phydev->master_slave_get = cfg; in genphy_read_master_slave()
2101 phydev->master_slave_state = state; in genphy_read_master_slave()
2110 int genphy_restart_aneg(struct phy_device *phydev) in genphy_restart_aneg() argument
2113 return phy_modify(phydev, MII_BMCR, BMCR_ISOLATE, in genphy_restart_aneg()
2125 int genphy_check_and_restart_aneg(struct phy_device *phydev, bool restart) in genphy_check_and_restart_aneg() argument
2133 ret = phy_read(phydev, MII_BMCR); in genphy_check_and_restart_aneg()
2142 return genphy_restart_aneg(phydev); in genphy_check_and_restart_aneg()
2157 int __genphy_config_aneg(struct phy_device *phydev, bool changed) in __genphy_config_aneg() argument
2161 if (genphy_config_eee_advert(phydev)) in __genphy_config_aneg()
2164 err = genphy_setup_master_slave(phydev); in __genphy_config_aneg()
2170 if (AUTONEG_ENABLE != phydev->autoneg) in __genphy_config_aneg()
2171 return genphy_setup_forced(phydev); in __genphy_config_aneg()
2173 err = genphy_config_advert(phydev); in __genphy_config_aneg()
2179 return genphy_check_and_restart_aneg(phydev, changed); in __genphy_config_aneg()
2192 int genphy_c37_config_aneg(struct phy_device *phydev) in genphy_c37_config_aneg() argument
2196 if (phydev->autoneg != AUTONEG_ENABLE) in genphy_c37_config_aneg()
2197 return genphy_setup_forced(phydev); in genphy_c37_config_aneg()
2199 err = phy_modify(phydev, MII_BMCR, BMCR_SPEED1000 | BMCR_SPEED100, in genphy_c37_config_aneg()
2204 changed = genphy_c37_config_advert(phydev); in genphy_c37_config_aneg()
2212 int ctl = phy_read(phydev, MII_BMCR); in genphy_c37_config_aneg()
2225 return genphy_restart_aneg(phydev); in genphy_c37_config_aneg()
2239 int genphy_aneg_done(struct phy_device *phydev) in genphy_aneg_done() argument
2241 int retval = phy_read(phydev, MII_BMSR); in genphy_aneg_done()
2255 int genphy_update_link(struct phy_device *phydev) in genphy_update_link() argument
2259 bmcr = phy_read(phydev, MII_BMCR); in genphy_update_link()
2274 if (!phy_polling_mode(phydev) || !phydev->link) { in genphy_update_link()
2275 status = phy_read(phydev, MII_BMSR); in genphy_update_link()
2283 status = phy_read(phydev, MII_BMSR); in genphy_update_link()
2287 phydev->link = status & BMSR_LSTATUS ? 1 : 0; in genphy_update_link()
2288 phydev->autoneg_complete = status & BMSR_ANEGCOMPLETE ? 1 : 0; in genphy_update_link()
2293 if (phydev->autoneg == AUTONEG_ENABLE && !phydev->autoneg_complete) in genphy_update_link()
2294 phydev->link = 0; in genphy_update_link()
2300 int genphy_read_lpa(struct phy_device *phydev) in genphy_read_lpa() argument
2304 if (phydev->autoneg == AUTONEG_ENABLE) { in genphy_read_lpa()
2305 if (!phydev->autoneg_complete) { in genphy_read_lpa()
2306 mii_stat1000_mod_linkmode_lpa_t(phydev->lp_advertising, in genphy_read_lpa()
2308 mii_lpa_mod_linkmode_lpa_t(phydev->lp_advertising, 0); in genphy_read_lpa()
2312 if (phydev->is_gigabit_capable) { in genphy_read_lpa()
2313 lpagb = phy_read(phydev, MII_STAT1000); in genphy_read_lpa()
2318 int adv = phy_read(phydev, MII_CTRL1000); in genphy_read_lpa()
2324 phydev_err(phydev, "Master/Slave resolution failed, maybe conflicting manual settings?\n"); in genphy_read_lpa()
2326 phydev_err(phydev, "Master/Slave resolution failed\n"); in genphy_read_lpa()
2330 mii_stat1000_mod_linkmode_lpa_t(phydev->lp_advertising, in genphy_read_lpa()
2334 lpa = phy_read(phydev, MII_LPA); in genphy_read_lpa()
2338 mii_lpa_mod_linkmode_lpa_t(phydev->lp_advertising, lpa); in genphy_read_lpa()
2340 linkmode_zero(phydev->lp_advertising); in genphy_read_lpa()
2354 int genphy_read_status_fixed(struct phy_device *phydev) in genphy_read_status_fixed() argument
2356 int bmcr = phy_read(phydev, MII_BMCR); in genphy_read_status_fixed()
2362 phydev->duplex = DUPLEX_FULL; in genphy_read_status_fixed()
2364 phydev->duplex = DUPLEX_HALF; in genphy_read_status_fixed()
2367 phydev->speed = SPEED_1000; in genphy_read_status_fixed()
2369 phydev->speed = SPEED_100; in genphy_read_status_fixed()
2371 phydev->speed = SPEED_10; in genphy_read_status_fixed()
2386 int genphy_read_status(struct phy_device *phydev) in genphy_read_status() argument
2388 int err, old_link = phydev->link; in genphy_read_status()
2391 err = genphy_update_link(phydev); in genphy_read_status()
2396 if (phydev->autoneg == AUTONEG_ENABLE && old_link && phydev->link) in genphy_read_status()
2399 phydev->speed = SPEED_UNKNOWN; in genphy_read_status()
2400 phydev->duplex = DUPLEX_UNKNOWN; in genphy_read_status()
2401 phydev->pause = 0; in genphy_read_status()
2402 phydev->asym_pause = 0; in genphy_read_status()
2404 err = genphy_read_master_slave(phydev); in genphy_read_status()
2408 err = genphy_read_lpa(phydev); in genphy_read_status()
2412 if (phydev->autoneg == AUTONEG_ENABLE && phydev->autoneg_complete) { in genphy_read_status()
2413 phy_resolve_aneg_linkmode(phydev); in genphy_read_status()
2414 } else if (phydev->autoneg == AUTONEG_DISABLE) { in genphy_read_status()
2415 err = genphy_read_status_fixed(phydev); in genphy_read_status()
2432 int genphy_c37_read_status(struct phy_device *phydev) in genphy_c37_read_status() argument
2434 int lpa, err, old_link = phydev->link; in genphy_c37_read_status()
2437 err = genphy_update_link(phydev); in genphy_c37_read_status()
2442 if (phydev->autoneg == AUTONEG_ENABLE && old_link && phydev->link) in genphy_c37_read_status()
2445 phydev->duplex = DUPLEX_UNKNOWN; in genphy_c37_read_status()
2446 phydev->pause = 0; in genphy_c37_read_status()
2447 phydev->asym_pause = 0; in genphy_c37_read_status()
2449 if (phydev->autoneg == AUTONEG_ENABLE && phydev->autoneg_complete) { in genphy_c37_read_status()
2450 lpa = phy_read(phydev, MII_LPA); in genphy_c37_read_status()
2455 phydev->lp_advertising, lpa & LPA_LPACK); in genphy_c37_read_status()
2457 phydev->lp_advertising, lpa & LPA_1000XFULL); in genphy_c37_read_status()
2459 phydev->lp_advertising, lpa & LPA_1000XPAUSE); in genphy_c37_read_status()
2461 phydev->lp_advertising, in genphy_c37_read_status()
2464 phy_resolve_aneg_linkmode(phydev); in genphy_c37_read_status()
2465 } else if (phydev->autoneg == AUTONEG_DISABLE) { in genphy_c37_read_status()
2466 int bmcr = phy_read(phydev, MII_BMCR); in genphy_c37_read_status()
2472 phydev->duplex = DUPLEX_FULL; in genphy_c37_read_status()
2474 phydev->duplex = DUPLEX_HALF; in genphy_c37_read_status()
2490 int genphy_soft_reset(struct phy_device *phydev) in genphy_soft_reset() argument
2495 if (phydev->autoneg == AUTONEG_ENABLE) in genphy_soft_reset()
2498 ret = phy_modify(phydev, MII_BMCR, BMCR_ISOLATE, res); in genphy_soft_reset()
2506 phydev->suspended = 0; in genphy_soft_reset()
2508 ret = phy_poll_reset(phydev); in genphy_soft_reset()
2513 if (phydev->autoneg == AUTONEG_DISABLE) in genphy_soft_reset()
2514 ret = genphy_setup_forced(phydev); in genphy_soft_reset()
2520 irqreturn_t genphy_handle_interrupt_no_ack(struct phy_device *phydev) in genphy_handle_interrupt_no_ack() argument
2527 phy_trigger_machine(phydev); in genphy_handle_interrupt_no_ack()
2542 int genphy_read_abilities(struct phy_device *phydev) in genphy_read_abilities() argument
2548 phydev->supported); in genphy_read_abilities()
2550 val = phy_read(phydev, MII_BMSR); in genphy_read_abilities()
2554 linkmode_mod_bit(ETHTOOL_LINK_MODE_Autoneg_BIT, phydev->supported, in genphy_read_abilities()
2557 linkmode_mod_bit(ETHTOOL_LINK_MODE_100baseT_Full_BIT, phydev->supported, in genphy_read_abilities()
2559 linkmode_mod_bit(ETHTOOL_LINK_MODE_100baseT_Half_BIT, phydev->supported, in genphy_read_abilities()
2561 linkmode_mod_bit(ETHTOOL_LINK_MODE_10baseT_Full_BIT, phydev->supported, in genphy_read_abilities()
2563 linkmode_mod_bit(ETHTOOL_LINK_MODE_10baseT_Half_BIT, phydev->supported, in genphy_read_abilities()
2567 val = phy_read(phydev, MII_ESTATUS); in genphy_read_abilities()
2572 phydev->supported, val & ESTATUS_1000_TFULL); in genphy_read_abilities()
2574 phydev->supported, val & ESTATUS_1000_THALF); in genphy_read_abilities()
2576 phydev->supported, val & ESTATUS_1000_XFULL); in genphy_read_abilities()
2600 int genphy_suspend(struct phy_device *phydev) in genphy_suspend() argument
2602 return phy_set_bits(phydev, MII_BMCR, BMCR_PDOWN); in genphy_suspend()
2606 int genphy_resume(struct phy_device *phydev) in genphy_resume() argument
2608 return phy_clear_bits(phydev, MII_BMCR, BMCR_PDOWN); in genphy_resume()
2612 int genphy_loopback(struct phy_device *phydev, bool enable) in genphy_loopback() argument
2618 if (phydev->speed == SPEED_1000) in genphy_loopback()
2620 else if (phydev->speed == SPEED_100) in genphy_loopback()
2623 if (phydev->duplex == DUPLEX_FULL) in genphy_loopback()
2626 phy_modify(phydev, MII_BMCR, ~0, ctl); in genphy_loopback()
2628 ret = phy_read_poll_timeout(phydev, MII_BMSR, val, in genphy_loopback()
2634 phy_modify(phydev, MII_BMCR, BMCR_LOOPBACK, 0); in genphy_loopback()
2636 phy_config_aneg(phydev); in genphy_loopback()
2652 void phy_remove_link_mode(struct phy_device *phydev, u32 link_mode) in phy_remove_link_mode() argument
2654 linkmode_clear_bit(link_mode, phydev->supported); in phy_remove_link_mode()
2655 phy_advertise_supported(phydev); in phy_remove_link_mode()
2674 void phy_advertise_supported(struct phy_device *phydev) in phy_advertise_supported() argument
2678 linkmode_copy(new, phydev->supported); in phy_advertise_supported()
2679 phy_copy_pause_bits(new, phydev->advertising); in phy_advertise_supported()
2680 linkmode_copy(phydev->advertising, new); in phy_advertise_supported()
2691 void phy_support_sym_pause(struct phy_device *phydev) in phy_support_sym_pause() argument
2693 linkmode_clear_bit(ETHTOOL_LINK_MODE_Asym_Pause_BIT, phydev->supported); in phy_support_sym_pause()
2694 phy_copy_pause_bits(phydev->advertising, phydev->supported); in phy_support_sym_pause()
2704 void phy_support_asym_pause(struct phy_device *phydev) in phy_support_asym_pause() argument
2706 phy_copy_pause_bits(phydev->advertising, phydev->supported); in phy_support_asym_pause()
2721 void phy_set_sym_pause(struct phy_device *phydev, bool rx, bool tx, in phy_set_sym_pause() argument
2724 linkmode_clear_bit(ETHTOOL_LINK_MODE_Pause_BIT, phydev->supported); in phy_set_sym_pause()
2728 phydev->supported); in phy_set_sym_pause()
2730 linkmode_copy(phydev->advertising, phydev->supported); in phy_set_sym_pause()
2745 void phy_set_asym_pause(struct phy_device *phydev, bool rx, bool tx) in phy_set_asym_pause() argument
2749 linkmode_copy(oldadv, phydev->advertising); in phy_set_asym_pause()
2750 linkmode_set_pause(phydev->advertising, tx, rx); in phy_set_asym_pause()
2752 if (!linkmode_equal(oldadv, phydev->advertising) && in phy_set_asym_pause()
2753 phydev->autoneg) in phy_set_asym_pause()
2754 phy_start_aneg(phydev); in phy_set_asym_pause()
2767 bool phy_validate_pause(struct phy_device *phydev, in phy_validate_pause() argument
2771 phydev->supported) && pp->rx_pause) in phy_validate_pause()
2775 phydev->supported) && in phy_validate_pause()
2795 void phy_get_pause(struct phy_device *phydev, bool *tx_pause, bool *rx_pause) in phy_get_pause() argument
2797 if (phydev->duplex != DUPLEX_FULL) { in phy_get_pause()
2803 return linkmode_resolve_pause(phydev->advertising, in phy_get_pause()
2804 phydev->lp_advertising, in phy_get_pause()
2844 s32 phy_get_internal_delay(struct phy_device *phydev, struct device *dev, in phy_get_internal_delay() argument
2853 if (phydev->interface == PHY_INTERFACE_MODE_RGMII_ID || in phy_get_internal_delay()
2854 phydev->interface == PHY_INTERFACE_MODE_RGMII_RXID) in phy_get_internal_delay()
2863 if (phydev->interface == PHY_INTERFACE_MODE_RGMII_ID || in phy_get_internal_delay()
2864 phydev->interface == PHY_INTERFACE_MODE_RGMII_TXID) in phy_get_internal_delay()
2878 phydev_err(phydev, "Delay %d is out of range\n", delay); in phy_get_internal_delay()
2900 phydev_err(phydev, "error finding internal delay index for %d\n", in phy_get_internal_delay()
3006 struct phy_device *phydev = to_phy_device(dev); in phy_probe() local
3007 struct device_driver *drv = phydev->mdio.dev.driver; in phy_probe()
3011 phydev->drv = phydrv; in phy_probe()
3016 if (!phy_drv_supports_irq(phydrv) && phy_interrupt_is_valid(phydev)) in phy_probe()
3017 phydev->irq = PHY_POLL; in phy_probe()
3020 phydev->is_internal = true; in phy_probe()
3022 mutex_lock(&phydev->lock); in phy_probe()
3025 phy_device_reset(phydev, 0); in phy_probe()
3027 if (phydev->drv->probe) { in phy_probe()
3028 err = phydev->drv->probe(phydev); in phy_probe()
3038 linkmode_copy(phydev->supported, phydrv->features); in phy_probe()
3040 err = phydrv->get_features(phydev); in phy_probe()
3041 else if (phydev->is_c45) in phy_probe()
3042 err = genphy_c45_pma_read_abilities(phydev); in phy_probe()
3044 err = genphy_read_abilities(phydev); in phy_probe()
3050 phydev->supported)) in phy_probe()
3051 phydev->autoneg = 0; in phy_probe()
3054 phydev->supported)) in phy_probe()
3055 phydev->is_gigabit_capable = 1; in phy_probe()
3057 phydev->supported)) in phy_probe()
3058 phydev->is_gigabit_capable = 1; in phy_probe()
3060 of_set_phy_supported(phydev); in phy_probe()
3061 phy_advertise_supported(phydev); in phy_probe()
3066 of_set_phy_eee_broken(phydev); in phy_probe()
3079 if (!test_bit(ETHTOOL_LINK_MODE_Pause_BIT, phydev->supported) && in phy_probe()
3080 !test_bit(ETHTOOL_LINK_MODE_Asym_Pause_BIT, phydev->supported)) { in phy_probe()
3082 phydev->supported); in phy_probe()
3084 phydev->supported); in phy_probe()
3088 phydev->state = PHY_READY; in phy_probe()
3093 phy_device_reset(phydev, 1); in phy_probe()
3095 mutex_unlock(&phydev->lock); in phy_probe()
3102 struct phy_device *phydev = to_phy_device(dev); in phy_remove() local
3104 cancel_delayed_work_sync(&phydev->state_queue); in phy_remove()
3106 mutex_lock(&phydev->lock); in phy_remove()
3107 phydev->state = PHY_DOWN; in phy_remove()
3108 mutex_unlock(&phydev->lock); in phy_remove()
3110 sfp_bus_del_upstream(phydev->sfp_bus); in phy_remove()
3111 phydev->sfp_bus = NULL; in phy_remove()
3113 if (phydev->drv && phydev->drv->remove) in phy_remove()
3114 phydev->drv->remove(phydev); in phy_remove()
3117 phy_device_reset(phydev, 1); in phy_remove()
3119 phydev->drv = NULL; in phy_remove()
3126 struct phy_device *phydev = to_phy_device(dev); in phy_shutdown() local
3128 if (phydev->state == PHY_READY || !phydev->attached_dev) in phy_shutdown()
3131 phy_disable_interrupts(phydev); in phy_shutdown()