cachepc-linux

Fork of AMDESE/linux with modifications for CachePC side-channel attack
git clone https://git.sinitax.com/sinitax/cachepc-linux
Log | Files | Refs | README | LICENSE | sfeed.txt

fwnode_mdio.c (3634B)

      1// SPDX-License-Identifier: GPL-2.0-only
      2/*
      3 * fwnode helpers for the MDIO (Ethernet PHY) API
      4 *
      5 * This file provides helper functions for extracting PHY device information
      6 * out of the fwnode and using it to populate an mii_bus.
      7 */
      8
      9#include <linux/acpi.h>
     10#include <linux/fwnode_mdio.h>
     11#include <linux/of.h>
     12#include <linux/phy.h>
     13
     14MODULE_AUTHOR("Calvin Johnson <calvin.johnson@oss.nxp.com>");
     15MODULE_LICENSE("GPL");
     16
     17static struct mii_timestamper *
     18fwnode_find_mii_timestamper(struct fwnode_handle *fwnode)
     19{
     20	struct of_phandle_args arg;
     21	int err;
     22
     23	if (is_acpi_node(fwnode))
     24		return NULL;
     25
     26	err = of_parse_phandle_with_fixed_args(to_of_node(fwnode),
     27					       "timestamper", 1, 0, &arg);
     28	if (err == -ENOENT)
     29		return NULL;
     30	else if (err)
     31		return ERR_PTR(err);
     32
     33	if (arg.args_count != 1)
     34		return ERR_PTR(-EINVAL);
     35
     36	return register_mii_timestamper(arg.np, arg.args[0]);
     37}
     38
     39int fwnode_mdiobus_phy_device_register(struct mii_bus *mdio,
     40				       struct phy_device *phy,
     41				       struct fwnode_handle *child, u32 addr)
     42{
     43	int rc;
     44
     45	rc = fwnode_irq_get(child, 0);
     46	/* Don't wait forever if the IRQ provider doesn't become available,
     47	 * just fall back to poll mode
     48	 */
     49	if (rc == -EPROBE_DEFER)
     50		rc = driver_deferred_probe_check_state(&phy->mdio.dev);
     51	if (rc == -EPROBE_DEFER)
     52		return rc;
     53
     54	if (rc > 0) {
     55		phy->irq = rc;
     56		mdio->irq[addr] = rc;
     57	} else {
     58		phy->irq = mdio->irq[addr];
     59	}
     60
     61	if (fwnode_property_read_bool(child, "broken-turn-around"))
     62		mdio->phy_ignore_ta_mask |= 1 << addr;
     63
     64	fwnode_property_read_u32(child, "reset-assert-us",
     65				 &phy->mdio.reset_assert_delay);
     66	fwnode_property_read_u32(child, "reset-deassert-us",
     67				 &phy->mdio.reset_deassert_delay);
     68
     69	/* Associate the fwnode with the device structure so it
     70	 * can be looked up later
     71	 */
     72	fwnode_handle_get(child);
     73	device_set_node(&phy->mdio.dev, child);
     74
     75	/* All data is now stored in the phy struct;
     76	 * register it
     77	 */
     78	rc = phy_device_register(phy);
     79	if (rc) {
     80		fwnode_handle_put(child);
     81		return rc;
     82	}
     83
     84	dev_dbg(&mdio->dev, "registered phy %p fwnode at address %i\n",
     85		child, addr);
     86	return 0;
     87}
     88EXPORT_SYMBOL(fwnode_mdiobus_phy_device_register);
     89
     90int fwnode_mdiobus_register_phy(struct mii_bus *bus,
     91				struct fwnode_handle *child, u32 addr)
     92{
     93	struct mii_timestamper *mii_ts = NULL;
     94	struct phy_device *phy;
     95	bool is_c45 = false;
     96	u32 phy_id;
     97	int rc;
     98
     99	mii_ts = fwnode_find_mii_timestamper(child);
    100	if (IS_ERR(mii_ts))
    101		return PTR_ERR(mii_ts);
    102
    103	rc = fwnode_property_match_string(child, "compatible",
    104					  "ethernet-phy-ieee802.3-c45");
    105	if (rc >= 0)
    106		is_c45 = true;
    107
    108	if (is_c45 || fwnode_get_phy_id(child, &phy_id))
    109		phy = get_phy_device(bus, addr, is_c45);
    110	else
    111		phy = phy_device_create(bus, addr, phy_id, 0, NULL);
    112	if (IS_ERR(phy)) {
    113		unregister_mii_timestamper(mii_ts);
    114		return PTR_ERR(phy);
    115	}
    116
    117	if (is_acpi_node(child)) {
    118		phy->irq = bus->irq[addr];
    119
    120		/* Associate the fwnode with the device structure so it
    121		 * can be looked up later.
    122		 */
    123		phy->mdio.dev.fwnode = child;
    124
    125		/* All data is now stored in the phy struct, so register it */
    126		rc = phy_device_register(phy);
    127		if (rc) {
    128			phy_device_free(phy);
    129			fwnode_handle_put(phy->mdio.dev.fwnode);
    130			return rc;
    131		}
    132	} else if (is_of_node(child)) {
    133		rc = fwnode_mdiobus_phy_device_register(bus, phy, child, addr);
    134		if (rc) {
    135			unregister_mii_timestamper(mii_ts);
    136			phy_device_free(phy);
    137			return rc;
    138		}
    139	}
    140
    141	/* phy->mii_ts may already be defined by the PHY driver. A
    142	 * mii_timestamper probed via the device tree will still have
    143	 * precedence.
    144	 */
    145	if (mii_ts)
    146		phy->mii_ts = mii_ts;
    147	return 0;
    148}
    149EXPORT_SYMBOL(fwnode_mdiobus_register_phy);