Lines Matching refs:phydev
204 void phy_device_free(struct phy_device *phydev) in phy_device_free() argument
206 put_device(&phydev->mdio.dev); in phy_device_free()
212 struct phy_device *phydev; in phy_mdio_device_free() local
214 phydev = container_of(mdiodev, struct phy_device, mdio); in phy_mdio_device_free()
215 phy_device_free(phydev); in phy_mdio_device_free()
226 struct phy_device *phydev; in phy_mdio_device_remove() local
228 phydev = container_of(mdiodev, struct phy_device, mdio); in phy_mdio_device_remove()
229 phy_device_remove(phydev); in phy_mdio_device_remove()
237 static bool mdio_bus_phy_may_suspend(struct phy_device *phydev) in mdio_bus_phy_may_suspend() argument
239 struct device_driver *drv = phydev->mdio.dev.driver; in mdio_bus_phy_may_suspend()
241 struct net_device *netdev = phydev->attached_dev; in mdio_bus_phy_may_suspend()
273 return !phydev->suspended; in mdio_bus_phy_may_suspend()
278 struct phy_device *phydev = to_phy_device(dev); in mdio_bus_phy_suspend() local
280 if (phydev->mac_managed_pm) in mdio_bus_phy_suspend()
287 if (phy_interrupt_is_valid(phydev)) { in mdio_bus_phy_suspend()
288 phydev->irq_suspended = 1; in mdio_bus_phy_suspend()
289 synchronize_irq(phydev->irq); in mdio_bus_phy_suspend()
297 if (phydev->attached_dev && phydev->adjust_link) in mdio_bus_phy_suspend()
298 phy_stop_machine(phydev); in mdio_bus_phy_suspend()
300 if (!mdio_bus_phy_may_suspend(phydev)) in mdio_bus_phy_suspend()
303 phydev->suspended_by_mdio_bus = 1; in mdio_bus_phy_suspend()
305 return phy_suspend(phydev); in mdio_bus_phy_suspend()
310 struct phy_device *phydev = to_phy_device(dev); in mdio_bus_phy_resume() local
313 if (phydev->mac_managed_pm) in mdio_bus_phy_resume()
316 if (!phydev->suspended_by_mdio_bus) in mdio_bus_phy_resume()
319 phydev->suspended_by_mdio_bus = 0; in mdio_bus_phy_resume()
326 WARN_ON(phydev->state != PHY_HALTED && phydev->state != PHY_READY && in mdio_bus_phy_resume()
327 phydev->state != PHY_UP); in mdio_bus_phy_resume()
329 ret = phy_init_hw(phydev); in mdio_bus_phy_resume()
333 ret = phy_resume(phydev); in mdio_bus_phy_resume()
337 if (phy_interrupt_is_valid(phydev)) { in mdio_bus_phy_resume()
338 phydev->irq_suspended = 0; in mdio_bus_phy_resume()
339 synchronize_irq(phydev->irq); in mdio_bus_phy_resume()
344 if (phydev->irq_rerun) { in mdio_bus_phy_resume()
345 phydev->irq_rerun = 0; in mdio_bus_phy_resume()
346 enable_irq(phydev->irq); in mdio_bus_phy_resume()
347 irq_wake_thread(phydev->irq, phydev); in mdio_bus_phy_resume()
351 if (phydev->attached_dev && phydev->adjust_link) in mdio_bus_phy_resume()
352 phy_start_machine(phydev); in mdio_bus_phy_resume()
456 static int phy_needs_fixup(struct phy_device *phydev, struct phy_fixup *fixup) in phy_needs_fixup() argument
458 if (strcmp(fixup->bus_id, phydev_name(phydev)) != 0) in phy_needs_fixup()
463 (phydev->phy_id & fixup->phy_uid_mask)) in phy_needs_fixup()
471 static int phy_scan_fixups(struct phy_device *phydev) in phy_scan_fixups() argument
477 if (phy_needs_fixup(phydev, fixup)) { in phy_scan_fixups()
478 int err = fixup->run(phydev); in phy_scan_fixups()
484 phydev->has_fixups = true; in phy_scan_fixups()
494 struct phy_device *phydev = to_phy_device(dev); in phy_bus_match() local
496 const int num_ids = ARRAY_SIZE(phydev->c45_ids.device_ids); in phy_bus_match()
503 return phydrv->match_phy_device(phydev); in phy_bus_match()
505 if (phydev->is_c45) { in phy_bus_match()
507 if (phydev->c45_ids.device_ids[i] == 0xffffffff) in phy_bus_match()
511 (phydev->c45_ids.device_ids[i] & in phy_bus_match()
518 (phydev->phy_id & phydrv->phy_id_mask); in phy_bus_match()
525 struct phy_device *phydev = to_phy_device(dev); in phy_id_show() local
527 return sysfs_emit(buf, "0x%.8lx\n", (unsigned long)phydev->phy_id); in phy_id_show()
534 struct phy_device *phydev = to_phy_device(dev); in phy_interface_show() local
537 if (phy_is_internal(phydev)) in phy_interface_show()
540 mode = phy_modes(phydev->interface); in phy_interface_show()
550 struct phy_device *phydev = to_phy_device(dev); in phy_has_fixups_show() local
552 return sysfs_emit(buf, "%d\n", phydev->has_fixups); in phy_has_fixups_show()
560 struct phy_device *phydev = to_phy_device(dev); in phy_dev_flags_show() local
562 return sysfs_emit(buf, "0x%08x\n", phydev->dev_flags); in phy_dev_flags_show()
950 int phy_device_register(struct phy_device *phydev) in phy_device_register() argument
954 err = mdiobus_register_device(&phydev->mdio); in phy_device_register()
959 phy_device_reset(phydev, 0); in phy_device_register()
962 err = phy_scan_fixups(phydev); in phy_device_register()
964 phydev_err(phydev, "failed to initialize\n"); in phy_device_register()
968 err = device_add(&phydev->mdio.dev); in phy_device_register()
970 phydev_err(phydev, "failed to add\n"); in phy_device_register()
978 phy_device_reset(phydev, 1); in phy_device_register()
980 mdiobus_unregister_device(&phydev->mdio); in phy_device_register()
993 void phy_device_remove(struct phy_device *phydev) in phy_device_remove() argument
995 unregister_mii_timestamper(phydev->mii_ts); in phy_device_remove()
996 pse_control_put(phydev->psec); in phy_device_remove()
998 device_del(&phydev->mdio.dev); in phy_device_remove()
1001 phy_device_reset(phydev, 1); in phy_device_remove()
1003 mdiobus_unregister_device(&phydev->mdio); in phy_device_remove()
1014 int phy_get_c45_ids(struct phy_device *phydev) in phy_get_c45_ids() argument
1016 return get_phy_c45_ids(phydev->mdio.bus, phydev->mdio.addr, in phy_get_c45_ids()
1017 &phydev->c45_ids); in phy_get_c45_ids()
1027 struct phy_device *phydev; in phy_find_first() local
1031 phydev = mdiobus_get_phy(bus, addr); in phy_find_first()
1032 if (phydev) in phy_find_first()
1033 return phydev; in phy_find_first()
1039 static void phy_link_change(struct phy_device *phydev, bool up) in phy_link_change() argument
1041 struct net_device *netdev = phydev->attached_dev; in phy_link_change()
1047 phydev->adjust_link(netdev); in phy_link_change()
1048 if (phydev->mii_ts && phydev->mii_ts->link_state) in phy_link_change()
1049 phydev->mii_ts->link_state(phydev->mii_ts, phydev); in phy_link_change()
1064 static void phy_prepare_link(struct phy_device *phydev, in phy_prepare_link() argument
1067 phydev->adjust_link = handler; in phy_prepare_link()
1077 int phy_connect_direct(struct net_device *dev, struct phy_device *phydev, in phy_connect_direct() argument
1086 rc = phy_attach_direct(dev, phydev, phydev->dev_flags, interface); in phy_connect_direct()
1090 phy_prepare_link(phydev, handler); in phy_connect_direct()
1091 if (phy_interrupt_is_valid(phydev)) in phy_connect_direct()
1092 phy_request_interrupt(phydev); in phy_connect_direct()
1117 struct phy_device *phydev; in phy_connect() local
1129 phydev = to_phy_device(d); in phy_connect()
1131 rc = phy_connect_direct(dev, phydev, handler, interface); in phy_connect()
1136 return phydev; in phy_connect()
1145 void phy_disconnect(struct phy_device *phydev) in phy_disconnect() argument
1147 if (phy_is_started(phydev)) in phy_disconnect()
1148 phy_stop(phydev); in phy_disconnect()
1150 if (phy_interrupt_is_valid(phydev)) in phy_disconnect()
1151 phy_free_interrupt(phydev); in phy_disconnect()
1153 phydev->adjust_link = NULL; in phy_disconnect()
1155 phy_detach(phydev); in phy_disconnect()
1177 static int phy_poll_reset(struct phy_device *phydev) in phy_poll_reset() argument
1182 ret = phy_read_poll_timeout(phydev, MII_BMCR, val, !(val & BMCR_RESET), in phy_poll_reset()
1193 int phy_init_hw(struct phy_device *phydev) in phy_init_hw() argument
1198 phy_device_reset(phydev, 0); in phy_init_hw()
1200 if (!phydev->drv) in phy_init_hw()
1203 if (phydev->drv->soft_reset) { in phy_init_hw()
1204 ret = phydev->drv->soft_reset(phydev); in phy_init_hw()
1207 phydev->suspended = 0; in phy_init_hw()
1213 ret = phy_scan_fixups(phydev); in phy_init_hw()
1217 if (phydev->drv->config_init) { in phy_init_hw()
1218 ret = phydev->drv->config_init(phydev); in phy_init_hw()
1223 if (phydev->drv->config_intr) { in phy_init_hw()
1224 ret = phydev->drv->config_intr(phydev); in phy_init_hw()
1233 void phy_attached_info(struct phy_device *phydev) in phy_attached_info() argument
1235 phy_attached_print(phydev, NULL); in phy_attached_info()
1240 char *phy_attached_info_irq(struct phy_device *phydev) in phy_attached_info_irq() argument
1245 switch(phydev->irq) { in phy_attached_info_irq()
1253 snprintf(irq_num, sizeof(irq_num), "%d", phydev->irq); in phy_attached_info_irq()
1262 void phy_attached_print(struct phy_device *phydev, const char *fmt, ...) in phy_attached_print() argument
1264 const char *unbound = phydev->drv ? "" : "[unbound] "; in phy_attached_print()
1265 char *irq_str = phy_attached_info_irq(phydev); in phy_attached_print()
1268 phydev_info(phydev, ATTACHED_FMT "\n", unbound, in phy_attached_print()
1269 phydev_name(phydev), irq_str); in phy_attached_print()
1273 phydev_info(phydev, ATTACHED_FMT, unbound, in phy_attached_print()
1274 phydev_name(phydev), irq_str); in phy_attached_print()
1284 static void phy_sysfs_create_links(struct phy_device *phydev) in phy_sysfs_create_links() argument
1286 struct net_device *dev = phydev->attached_dev; in phy_sysfs_create_links()
1292 err = sysfs_create_link(&phydev->mdio.dev.kobj, &dev->dev.kobj, in phy_sysfs_create_links()
1298 &phydev->mdio.dev.kobj, in phy_sysfs_create_links()
1302 kobject_name(&phydev->mdio.dev.kobj), in phy_sysfs_create_links()
1309 phydev->sysfs_links = true; in phy_sysfs_create_links()
1316 struct phy_device *phydev = to_phy_device(dev); in phy_standalone_show() local
1318 return sysfs_emit(buf, "%d\n", !phydev->attached_dev); in phy_standalone_show()
1331 struct phy_device *phydev = upstream; in phy_sfp_attach() local
1333 if (phydev->attached_dev) in phy_sfp_attach()
1334 phydev->attached_dev->sfp_bus = bus; in phy_sfp_attach()
1335 phydev->sfp_bus_attached = true; in phy_sfp_attach()
1348 struct phy_device *phydev = upstream; in phy_sfp_detach() local
1350 if (phydev->attached_dev) in phy_sfp_detach()
1351 phydev->attached_dev->sfp_bus = NULL; in phy_sfp_detach()
1352 phydev->sfp_bus_attached = false; in phy_sfp_detach()
1361 int phy_sfp_probe(struct phy_device *phydev, in phy_sfp_probe() argument
1367 if (phydev->mdio.dev.fwnode) { in phy_sfp_probe()
1368 bus = sfp_bus_find_fwnode(phydev->mdio.dev.fwnode); in phy_sfp_probe()
1372 phydev->sfp_bus = bus; in phy_sfp_probe()
1374 ret = sfp_bus_add_upstream(bus, phydev, ops); in phy_sfp_probe()
1396 int phy_attach_direct(struct net_device *dev, struct phy_device *phydev, in phy_attach_direct() argument
1399 struct mii_bus *bus = phydev->mdio.bus; in phy_attach_direct()
1400 struct device *d = &phydev->mdio.dev; in phy_attach_direct()
1413 phydev_err(phydev, "failed to get the bus module\n"); in phy_attach_direct()
1423 if (phydev->is_c45) in phy_attach_direct()
1432 phydev_err(phydev, "failed to get the device driver module\n"); in phy_attach_direct()
1446 if (phydev->attached_dev) { in phy_attach_direct()
1452 phydev->phy_link_change = phy_link_change; in phy_attach_direct()
1454 phydev->attached_dev = dev; in phy_attach_direct()
1455 dev->phydev = phydev; in phy_attach_direct()
1457 if (phydev->sfp_bus_attached) in phy_attach_direct()
1458 dev->sfp_bus = phydev->sfp_bus; in phy_attach_direct()
1460 phydev->is_on_sfp_module = true; in phy_attach_direct()
1471 phydev->sysfs_links = false; in phy_attach_direct()
1473 phy_sysfs_create_links(phydev); in phy_attach_direct()
1475 if (!phydev->attached_dev) { in phy_attach_direct()
1476 err = sysfs_create_file(&phydev->mdio.dev.kobj, in phy_attach_direct()
1479 phydev_err(phydev, "error creating 'phy_standalone' sysfs entry\n"); in phy_attach_direct()
1482 phydev->dev_flags |= flags; in phy_attach_direct()
1484 phydev->interface = interface; in phy_attach_direct()
1486 phydev->state = PHY_READY; in phy_attach_direct()
1488 phydev->interrupts = PHY_INTERRUPT_DISABLED; in phy_attach_direct()
1496 phydev->port = PORT_MII; in phy_attach_direct()
1502 netif_carrier_off(phydev->attached_dev); in phy_attach_direct()
1508 err = phy_init_hw(phydev); in phy_attach_direct()
1512 phy_resume(phydev); in phy_attach_direct()
1513 phy_led_triggers_register(phydev); in phy_attach_direct()
1519 phy_detach(phydev); in phy_attach_direct()
1546 struct phy_device *phydev; in phy_attach() local
1561 phydev = to_phy_device(d); in phy_attach()
1563 rc = phy_attach_direct(dev, phydev, phydev->dev_flags, interface); in phy_attach()
1568 return phydev; in phy_attach()
1572 static bool phy_driver_is_genphy_kind(struct phy_device *phydev, in phy_driver_is_genphy_kind() argument
1575 struct device *d = &phydev->mdio.dev; in phy_driver_is_genphy_kind()
1578 if (!phydev->drv) in phy_driver_is_genphy_kind()
1588 bool phy_driver_is_genphy(struct phy_device *phydev) in phy_driver_is_genphy() argument
1590 return phy_driver_is_genphy_kind(phydev, in phy_driver_is_genphy()
1595 bool phy_driver_is_genphy_10g(struct phy_device *phydev) in phy_driver_is_genphy_10g() argument
1597 return phy_driver_is_genphy_kind(phydev, in phy_driver_is_genphy_10g()
1628 int phy_package_join(struct phy_device *phydev, int addr, size_t priv_size) in phy_package_join() argument
1630 struct mii_bus *bus = phydev->mdio.bus; in phy_package_join()
1661 phydev->shared = shared; in phy_package_join()
1681 void phy_package_leave(struct phy_device *phydev) in phy_package_leave() argument
1683 struct phy_package_shared *shared = phydev->shared; in phy_package_leave()
1684 struct mii_bus *bus = phydev->mdio.bus; in phy_package_leave()
1696 phydev->shared = NULL; in phy_package_leave()
1716 int devm_phy_package_join(struct device *dev, struct phy_device *phydev, in devm_phy_package_join() argument
1727 ret = phy_package_join(phydev, addr, priv_size); in devm_phy_package_join()
1730 *ptr = phydev; in devm_phy_package_join()
1747 void phy_detach(struct phy_device *phydev) in phy_detach() argument
1749 struct net_device *dev = phydev->attached_dev; in phy_detach()
1753 if (phydev->sysfs_links) { in phy_detach()
1756 sysfs_remove_link(&phydev->mdio.dev.kobj, "attached_dev"); in phy_detach()
1759 if (!phydev->attached_dev) in phy_detach()
1760 sysfs_remove_file(&phydev->mdio.dev.kobj, in phy_detach()
1763 phy_suspend(phydev); in phy_detach()
1765 phydev->attached_dev->phydev = NULL; in phy_detach()
1766 phydev->attached_dev = NULL; in phy_detach()
1768 phydev->phylink = NULL; in phy_detach()
1770 phy_led_triggers_unregister(phydev); in phy_detach()
1772 if (phydev->mdio.dev.driver) in phy_detach()
1773 module_put(phydev->mdio.dev.driver->owner); in phy_detach()
1780 if (phy_driver_is_genphy(phydev) || in phy_detach()
1781 phy_driver_is_genphy_10g(phydev)) in phy_detach()
1782 device_release_driver(&phydev->mdio.dev); in phy_detach()
1785 phy_device_reset(phydev, 1); in phy_detach()
1791 bus = phydev->mdio.bus; in phy_detach()
1793 put_device(&phydev->mdio.dev); in phy_detach()
1801 int phy_suspend(struct phy_device *phydev) in phy_suspend() argument
1804 struct net_device *netdev = phydev->attached_dev; in phy_suspend()
1805 struct phy_driver *phydrv = phydev->drv; in phy_suspend()
1808 if (phydev->suspended) in phy_suspend()
1812 phy_ethtool_get_wol(phydev, &wol); in phy_suspend()
1819 ret = phydrv->suspend(phydev); in phy_suspend()
1821 phydev->suspended = true; in phy_suspend()
1827 int __phy_resume(struct phy_device *phydev) in __phy_resume() argument
1829 struct phy_driver *phydrv = phydev->drv; in __phy_resume()
1832 lockdep_assert_held(&phydev->lock); in __phy_resume()
1837 ret = phydrv->resume(phydev); in __phy_resume()
1839 phydev->suspended = false; in __phy_resume()
1845 int phy_resume(struct phy_device *phydev) in phy_resume() argument
1849 mutex_lock(&phydev->lock); in phy_resume()
1850 ret = __phy_resume(phydev); in phy_resume()
1851 mutex_unlock(&phydev->lock); in phy_resume()
1857 int phy_loopback(struct phy_device *phydev, bool enable) in phy_loopback() argument
1861 if (!phydev->drv) in phy_loopback()
1864 mutex_lock(&phydev->lock); in phy_loopback()
1866 if (enable && phydev->loopback_enabled) { in phy_loopback()
1871 if (!enable && !phydev->loopback_enabled) { in phy_loopback()
1876 if (phydev->drv->set_loopback) in phy_loopback()
1877 ret = phydev->drv->set_loopback(phydev, enable); in phy_loopback()
1879 ret = genphy_loopback(phydev, enable); in phy_loopback()
1884 phydev->loopback_enabled = enable; in phy_loopback()
1887 mutex_unlock(&phydev->lock); in phy_loopback()
1901 int phy_reset_after_clk_enable(struct phy_device *phydev) in phy_reset_after_clk_enable() argument
1903 if (!phydev || !phydev->drv) in phy_reset_after_clk_enable()
1906 if (phydev->drv->flags & PHY_RST_AFTER_CLK_EN) { in phy_reset_after_clk_enable()
1907 phy_device_reset(phydev, 1); in phy_reset_after_clk_enable()
1908 phy_device_reset(phydev, 0); in phy_reset_after_clk_enable()
1927 static int genphy_config_advert(struct phy_device *phydev) in genphy_config_advert() argument
1933 linkmode_and(phydev->advertising, phydev->advertising, in genphy_config_advert()
1934 phydev->supported); in genphy_config_advert()
1936 adv = linkmode_adv_to_mii_adv_t(phydev->advertising); in genphy_config_advert()
1939 err = phy_modify_changed(phydev, MII_ADVERTISE, in genphy_config_advert()
1948 bmsr = phy_read(phydev, MII_BMSR); in genphy_config_advert()
1959 adv = linkmode_adv_to_mii_ctrl1000_t(phydev->advertising); in genphy_config_advert()
1961 err = phy_modify_changed(phydev, MII_CTRL1000, in genphy_config_advert()
1982 static int genphy_c37_config_advert(struct phy_device *phydev) in genphy_c37_config_advert() argument
1987 linkmode_and(phydev->advertising, phydev->advertising, in genphy_c37_config_advert()
1988 phydev->supported); in genphy_c37_config_advert()
1991 phydev->advertising)) in genphy_c37_config_advert()
1994 phydev->advertising)) in genphy_c37_config_advert()
1997 phydev->advertising)) in genphy_c37_config_advert()
2000 return phy_modify_changed(phydev, MII_ADVERTISE, in genphy_c37_config_advert()
2014 int genphy_config_eee_advert(struct phy_device *phydev) in genphy_config_eee_advert() argument
2019 if (!phydev->eee_broken_modes) in genphy_config_eee_advert()
2022 err = phy_modify_mmd_changed(phydev, MDIO_MMD_AN, MDIO_AN_EEE_ADV, in genphy_config_eee_advert()
2023 phydev->eee_broken_modes, 0); in genphy_config_eee_advert()
2037 int genphy_setup_forced(struct phy_device *phydev) in genphy_setup_forced() argument
2041 phydev->pause = 0; in genphy_setup_forced()
2042 phydev->asym_pause = 0; in genphy_setup_forced()
2044 ctl = mii_bmcr_encode_fixed(phydev->speed, phydev->duplex); in genphy_setup_forced()
2046 return phy_modify(phydev, MII_BMCR, in genphy_setup_forced()
2051 static int genphy_setup_master_slave(struct phy_device *phydev) in genphy_setup_master_slave() argument
2055 if (!phydev->is_gigabit_capable) in genphy_setup_master_slave()
2058 switch (phydev->master_slave_set) { in genphy_setup_master_slave()
2074 phydev_warn(phydev, "Unsupported Master/Slave mode\n"); in genphy_setup_master_slave()
2078 return phy_modify_changed(phydev, MII_CTRL1000, in genphy_setup_master_slave()
2083 int genphy_read_master_slave(struct phy_device *phydev) in genphy_read_master_slave() argument
2088 phydev->master_slave_get = MASTER_SLAVE_CFG_UNKNOWN; in genphy_read_master_slave()
2089 phydev->master_slave_state = MASTER_SLAVE_STATE_UNKNOWN; in genphy_read_master_slave()
2091 val = phy_read(phydev, MII_CTRL1000); in genphy_read_master_slave()
2107 val = phy_read(phydev, MII_STAT1000); in genphy_read_master_slave()
2113 } else if (phydev->link) { in genphy_read_master_slave()
2123 phydev->master_slave_get = cfg; in genphy_read_master_slave()
2124 phydev->master_slave_state = state; in genphy_read_master_slave()
2134 int genphy_restart_aneg(struct phy_device *phydev) in genphy_restart_aneg() argument
2137 return phy_modify(phydev, MII_BMCR, BMCR_ISOLATE, in genphy_restart_aneg()
2149 int genphy_check_and_restart_aneg(struct phy_device *phydev, bool restart) in genphy_check_and_restart_aneg() argument
2157 ret = phy_read(phydev, MII_BMCR); in genphy_check_and_restart_aneg()
2166 return genphy_restart_aneg(phydev); in genphy_check_and_restart_aneg()
2181 int __genphy_config_aneg(struct phy_device *phydev, bool changed) in __genphy_config_aneg() argument
2185 if (genphy_config_eee_advert(phydev)) in __genphy_config_aneg()
2188 err = genphy_setup_master_slave(phydev); in __genphy_config_aneg()
2194 if (AUTONEG_ENABLE != phydev->autoneg) in __genphy_config_aneg()
2195 return genphy_setup_forced(phydev); in __genphy_config_aneg()
2197 err = genphy_config_advert(phydev); in __genphy_config_aneg()
2203 return genphy_check_and_restart_aneg(phydev, changed); in __genphy_config_aneg()
2216 int genphy_c37_config_aneg(struct phy_device *phydev) in genphy_c37_config_aneg() argument
2220 if (phydev->autoneg != AUTONEG_ENABLE) in genphy_c37_config_aneg()
2221 return genphy_setup_forced(phydev); in genphy_c37_config_aneg()
2223 err = phy_modify(phydev, MII_BMCR, BMCR_SPEED1000 | BMCR_SPEED100, in genphy_c37_config_aneg()
2228 changed = genphy_c37_config_advert(phydev); in genphy_c37_config_aneg()
2236 int ctl = phy_read(phydev, MII_BMCR); in genphy_c37_config_aneg()
2249 return genphy_restart_aneg(phydev); in genphy_c37_config_aneg()
2263 int genphy_aneg_done(struct phy_device *phydev) in genphy_aneg_done() argument
2265 int retval = phy_read(phydev, MII_BMSR); in genphy_aneg_done()
2279 int genphy_update_link(struct phy_device *phydev) in genphy_update_link() argument
2283 bmcr = phy_read(phydev, MII_BMCR); in genphy_update_link()
2298 if (!phy_polling_mode(phydev) || !phydev->link) { in genphy_update_link()
2299 status = phy_read(phydev, MII_BMSR); in genphy_update_link()
2307 status = phy_read(phydev, MII_BMSR); in genphy_update_link()
2311 phydev->link = status & BMSR_LSTATUS ? 1 : 0; in genphy_update_link()
2312 phydev->autoneg_complete = status & BMSR_ANEGCOMPLETE ? 1 : 0; in genphy_update_link()
2317 if (phydev->autoneg == AUTONEG_ENABLE && !phydev->autoneg_complete) in genphy_update_link()
2318 phydev->link = 0; in genphy_update_link()
2324 int genphy_read_lpa(struct phy_device *phydev) in genphy_read_lpa() argument
2328 if (phydev->autoneg == AUTONEG_ENABLE) { in genphy_read_lpa()
2329 if (!phydev->autoneg_complete) { in genphy_read_lpa()
2330 mii_stat1000_mod_linkmode_lpa_t(phydev->lp_advertising, in genphy_read_lpa()
2332 mii_lpa_mod_linkmode_lpa_t(phydev->lp_advertising, 0); in genphy_read_lpa()
2336 if (phydev->is_gigabit_capable) { in genphy_read_lpa()
2337 lpagb = phy_read(phydev, MII_STAT1000); in genphy_read_lpa()
2342 int adv = phy_read(phydev, MII_CTRL1000); in genphy_read_lpa()
2348 phydev_err(phydev, "Master/Slave resolution failed, maybe conflicting manual settings?\n"); in genphy_read_lpa()
2350 phydev_err(phydev, "Master/Slave resolution failed\n"); in genphy_read_lpa()
2354 mii_stat1000_mod_linkmode_lpa_t(phydev->lp_advertising, in genphy_read_lpa()
2358 lpa = phy_read(phydev, MII_LPA); in genphy_read_lpa()
2362 mii_lpa_mod_linkmode_lpa_t(phydev->lp_advertising, lpa); in genphy_read_lpa()
2364 linkmode_zero(phydev->lp_advertising); in genphy_read_lpa()
2378 int genphy_read_status_fixed(struct phy_device *phydev) in genphy_read_status_fixed() argument
2380 int bmcr = phy_read(phydev, MII_BMCR); in genphy_read_status_fixed()
2386 phydev->duplex = DUPLEX_FULL; in genphy_read_status_fixed()
2388 phydev->duplex = DUPLEX_HALF; in genphy_read_status_fixed()
2391 phydev->speed = SPEED_1000; in genphy_read_status_fixed()
2393 phydev->speed = SPEED_100; in genphy_read_status_fixed()
2395 phydev->speed = SPEED_10; in genphy_read_status_fixed()
2410 int genphy_read_status(struct phy_device *phydev) in genphy_read_status() argument
2412 int err, old_link = phydev->link; in genphy_read_status()
2415 err = genphy_update_link(phydev); in genphy_read_status()
2420 if (phydev->autoneg == AUTONEG_ENABLE && old_link && phydev->link) in genphy_read_status()
2423 phydev->master_slave_get = MASTER_SLAVE_CFG_UNSUPPORTED; in genphy_read_status()
2424 phydev->master_slave_state = MASTER_SLAVE_STATE_UNSUPPORTED; in genphy_read_status()
2425 phydev->speed = SPEED_UNKNOWN; in genphy_read_status()
2426 phydev->duplex = DUPLEX_UNKNOWN; in genphy_read_status()
2427 phydev->pause = 0; in genphy_read_status()
2428 phydev->asym_pause = 0; in genphy_read_status()
2430 if (phydev->is_gigabit_capable) { in genphy_read_status()
2431 err = genphy_read_master_slave(phydev); in genphy_read_status()
2436 err = genphy_read_lpa(phydev); in genphy_read_status()
2440 if (phydev->autoneg == AUTONEG_ENABLE && phydev->autoneg_complete) { in genphy_read_status()
2441 phy_resolve_aneg_linkmode(phydev); in genphy_read_status()
2442 } else if (phydev->autoneg == AUTONEG_DISABLE) { in genphy_read_status()
2443 err = genphy_read_status_fixed(phydev); in genphy_read_status()
2460 int genphy_c37_read_status(struct phy_device *phydev) in genphy_c37_read_status() argument
2462 int lpa, err, old_link = phydev->link; in genphy_c37_read_status()
2465 err = genphy_update_link(phydev); in genphy_c37_read_status()
2470 if (phydev->autoneg == AUTONEG_ENABLE && old_link && phydev->link) in genphy_c37_read_status()
2473 phydev->duplex = DUPLEX_UNKNOWN; in genphy_c37_read_status()
2474 phydev->pause = 0; in genphy_c37_read_status()
2475 phydev->asym_pause = 0; in genphy_c37_read_status()
2477 if (phydev->autoneg == AUTONEG_ENABLE && phydev->autoneg_complete) { in genphy_c37_read_status()
2478 lpa = phy_read(phydev, MII_LPA); in genphy_c37_read_status()
2483 phydev->lp_advertising, lpa & LPA_LPACK); in genphy_c37_read_status()
2485 phydev->lp_advertising, lpa & LPA_1000XFULL); in genphy_c37_read_status()
2487 phydev->lp_advertising, lpa & LPA_1000XPAUSE); in genphy_c37_read_status()
2489 phydev->lp_advertising, in genphy_c37_read_status()
2492 phy_resolve_aneg_linkmode(phydev); in genphy_c37_read_status()
2493 } else if (phydev->autoneg == AUTONEG_DISABLE) { in genphy_c37_read_status()
2494 int bmcr = phy_read(phydev, MII_BMCR); in genphy_c37_read_status()
2500 phydev->duplex = DUPLEX_FULL; in genphy_c37_read_status()
2502 phydev->duplex = DUPLEX_HALF; in genphy_c37_read_status()
2518 int genphy_soft_reset(struct phy_device *phydev) in genphy_soft_reset() argument
2523 if (phydev->autoneg == AUTONEG_ENABLE) in genphy_soft_reset()
2526 ret = phy_modify(phydev, MII_BMCR, BMCR_ISOLATE, res); in genphy_soft_reset()
2534 phydev->suspended = 0; in genphy_soft_reset()
2536 ret = phy_poll_reset(phydev); in genphy_soft_reset()
2541 if (phydev->autoneg == AUTONEG_DISABLE) in genphy_soft_reset()
2542 ret = genphy_setup_forced(phydev); in genphy_soft_reset()
2548 irqreturn_t genphy_handle_interrupt_no_ack(struct phy_device *phydev) in genphy_handle_interrupt_no_ack() argument
2555 phy_trigger_machine(phydev); in genphy_handle_interrupt_no_ack()
2570 int genphy_read_abilities(struct phy_device *phydev) in genphy_read_abilities() argument
2576 phydev->supported); in genphy_read_abilities()
2578 val = phy_read(phydev, MII_BMSR); in genphy_read_abilities()
2582 linkmode_mod_bit(ETHTOOL_LINK_MODE_Autoneg_BIT, phydev->supported, in genphy_read_abilities()
2585 linkmode_mod_bit(ETHTOOL_LINK_MODE_100baseT_Full_BIT, phydev->supported, in genphy_read_abilities()
2587 linkmode_mod_bit(ETHTOOL_LINK_MODE_100baseT_Half_BIT, phydev->supported, in genphy_read_abilities()
2589 linkmode_mod_bit(ETHTOOL_LINK_MODE_10baseT_Full_BIT, phydev->supported, in genphy_read_abilities()
2591 linkmode_mod_bit(ETHTOOL_LINK_MODE_10baseT_Half_BIT, phydev->supported, in genphy_read_abilities()
2595 val = phy_read(phydev, MII_ESTATUS); in genphy_read_abilities()
2600 phydev->supported, val & ESTATUS_1000_TFULL); in genphy_read_abilities()
2602 phydev->supported, val & ESTATUS_1000_THALF); in genphy_read_abilities()
2604 phydev->supported, val & ESTATUS_1000_XFULL); in genphy_read_abilities()
2628 int genphy_suspend(struct phy_device *phydev) in genphy_suspend() argument
2630 return phy_set_bits(phydev, MII_BMCR, BMCR_PDOWN); in genphy_suspend()
2634 int genphy_resume(struct phy_device *phydev) in genphy_resume() argument
2636 return phy_clear_bits(phydev, MII_BMCR, BMCR_PDOWN); in genphy_resume()
2640 int genphy_loopback(struct phy_device *phydev, bool enable) in genphy_loopback() argument
2646 ctl |= mii_bmcr_encode_fixed(phydev->speed, phydev->duplex); in genphy_loopback()
2648 phy_modify(phydev, MII_BMCR, ~0, ctl); in genphy_loopback()
2650 ret = phy_read_poll_timeout(phydev, MII_BMSR, val, in genphy_loopback()
2656 phy_modify(phydev, MII_BMCR, BMCR_LOOPBACK, 0); in genphy_loopback()
2658 phy_config_aneg(phydev); in genphy_loopback()
2674 void phy_remove_link_mode(struct phy_device *phydev, u32 link_mode) in phy_remove_link_mode() argument
2676 linkmode_clear_bit(link_mode, phydev->supported); in phy_remove_link_mode()
2677 phy_advertise_supported(phydev); in phy_remove_link_mode()
2696 void phy_advertise_supported(struct phy_device *phydev) in phy_advertise_supported() argument
2700 linkmode_copy(new, phydev->supported); in phy_advertise_supported()
2701 phy_copy_pause_bits(new, phydev->advertising); in phy_advertise_supported()
2702 linkmode_copy(phydev->advertising, new); in phy_advertise_supported()
2713 void phy_support_sym_pause(struct phy_device *phydev) in phy_support_sym_pause() argument
2715 linkmode_clear_bit(ETHTOOL_LINK_MODE_Asym_Pause_BIT, phydev->supported); in phy_support_sym_pause()
2716 phy_copy_pause_bits(phydev->advertising, phydev->supported); in phy_support_sym_pause()
2726 void phy_support_asym_pause(struct phy_device *phydev) in phy_support_asym_pause() argument
2728 phy_copy_pause_bits(phydev->advertising, phydev->supported); in phy_support_asym_pause()
2743 void phy_set_sym_pause(struct phy_device *phydev, bool rx, bool tx, in phy_set_sym_pause() argument
2746 linkmode_clear_bit(ETHTOOL_LINK_MODE_Pause_BIT, phydev->supported); in phy_set_sym_pause()
2750 phydev->supported); in phy_set_sym_pause()
2752 linkmode_copy(phydev->advertising, phydev->supported); in phy_set_sym_pause()
2767 void phy_set_asym_pause(struct phy_device *phydev, bool rx, bool tx) in phy_set_asym_pause() argument
2771 linkmode_copy(oldadv, phydev->advertising); in phy_set_asym_pause()
2772 linkmode_set_pause(phydev->advertising, tx, rx); in phy_set_asym_pause()
2774 if (!linkmode_equal(oldadv, phydev->advertising) && in phy_set_asym_pause()
2775 phydev->autoneg) in phy_set_asym_pause()
2776 phy_start_aneg(phydev); in phy_set_asym_pause()
2789 bool phy_validate_pause(struct phy_device *phydev, in phy_validate_pause() argument
2793 phydev->supported) && pp->rx_pause) in phy_validate_pause()
2797 phydev->supported) && in phy_validate_pause()
2817 void phy_get_pause(struct phy_device *phydev, bool *tx_pause, bool *rx_pause) in phy_get_pause() argument
2819 if (phydev->duplex != DUPLEX_FULL) { in phy_get_pause()
2825 return linkmode_resolve_pause(phydev->advertising, in phy_get_pause()
2826 phydev->lp_advertising, in phy_get_pause()
2866 s32 phy_get_internal_delay(struct phy_device *phydev, struct device *dev, in phy_get_internal_delay() argument
2875 if (phydev->interface == PHY_INTERFACE_MODE_RGMII_ID || in phy_get_internal_delay()
2876 phydev->interface == PHY_INTERFACE_MODE_RGMII_RXID) in phy_get_internal_delay()
2885 if (phydev->interface == PHY_INTERFACE_MODE_RGMII_ID || in phy_get_internal_delay()
2886 phydev->interface == PHY_INTERFACE_MODE_RGMII_TXID) in phy_get_internal_delay()
2900 phydev_err(phydev, "Delay %d is out of range\n", delay); in phy_get_internal_delay()
2922 phydev_err(phydev, "error finding internal delay index for %d\n", in phy_get_internal_delay()
3028 struct phy_device *phydev = to_phy_device(dev); in phy_probe() local
3029 struct device_driver *drv = phydev->mdio.dev.driver; in phy_probe()
3033 phydev->drv = phydrv; in phy_probe()
3038 if (!phy_drv_supports_irq(phydrv) && phy_interrupt_is_valid(phydev)) in phy_probe()
3039 phydev->irq = PHY_POLL; in phy_probe()
3042 phydev->is_internal = true; in phy_probe()
3044 mutex_lock(&phydev->lock); in phy_probe()
3047 phy_device_reset(phydev, 0); in phy_probe()
3049 if (phydev->drv->probe) { in phy_probe()
3050 err = phydev->drv->probe(phydev); in phy_probe()
3060 linkmode_copy(phydev->supported, phydrv->features); in phy_probe()
3062 err = phydrv->get_features(phydev); in phy_probe()
3063 else if (phydev->is_c45) in phy_probe()
3064 err = genphy_c45_pma_read_abilities(phydev); in phy_probe()
3066 err = genphy_read_abilities(phydev); in phy_probe()
3072 phydev->supported)) in phy_probe()
3073 phydev->autoneg = 0; in phy_probe()
3076 phydev->supported)) in phy_probe()
3077 phydev->is_gigabit_capable = 1; in phy_probe()
3079 phydev->supported)) in phy_probe()
3080 phydev->is_gigabit_capable = 1; in phy_probe()
3082 of_set_phy_supported(phydev); in phy_probe()
3083 phy_advertise_supported(phydev); in phy_probe()
3088 of_set_phy_eee_broken(phydev); in phy_probe()
3101 if (!test_bit(ETHTOOL_LINK_MODE_Pause_BIT, phydev->supported) && in phy_probe()
3102 !test_bit(ETHTOOL_LINK_MODE_Asym_Pause_BIT, phydev->supported)) { in phy_probe()
3104 phydev->supported); in phy_probe()
3106 phydev->supported); in phy_probe()
3110 phydev->state = PHY_READY; in phy_probe()
3115 phy_device_reset(phydev, 1); in phy_probe()
3117 mutex_unlock(&phydev->lock); in phy_probe()
3124 struct phy_device *phydev = to_phy_device(dev); in phy_remove() local
3126 cancel_delayed_work_sync(&phydev->state_queue); in phy_remove()
3128 mutex_lock(&phydev->lock); in phy_remove()
3129 phydev->state = PHY_DOWN; in phy_remove()
3130 mutex_unlock(&phydev->lock); in phy_remove()
3132 sfp_bus_del_upstream(phydev->sfp_bus); in phy_remove()
3133 phydev->sfp_bus = NULL; in phy_remove()
3135 if (phydev->drv && phydev->drv->remove) in phy_remove()
3136 phydev->drv->remove(phydev); in phy_remove()
3139 phy_device_reset(phydev, 1); in phy_remove()
3141 phydev->drv = NULL; in phy_remove()
3148 struct phy_device *phydev = to_phy_device(dev); in phy_shutdown() local
3150 if (phydev->state == PHY_READY || !phydev->attached_dev) in phy_shutdown()
3153 phy_disable_interrupts(phydev); in phy_shutdown()