On Thu, Mar 12, 2020 at 07:34:18AM +0100, Oleksij Rempel wrote:
> This function will be needed in tja11xx driver for secondary PHY
> support.
> 
> Signed-off-by: Oleksij Rempel <o.rempel@pengutronix.de>
> ---
>  drivers/of/of_mdio.c    | 74 ++++++++++++++++++++++++-----------------
>  include/linux/of_mdio.h | 11 +++++-
>  2 files changed, 53 insertions(+), 32 deletions(-)
> 
> diff --git a/drivers/of/of_mdio.c b/drivers/of/of_mdio.c
> index 8270bbf505fb..6ee7e49dcb86 100644
> --- a/drivers/of/of_mdio.c
> +++ b/drivers/of/of_mdio.c
> @@ -60,39 +60,16 @@ static struct mii_timestamper *of_find_mii_timestamper(struct device_node *node)
>  	return register_mii_timestamper(arg.np, arg.args[0]);
>  }
>  
> -static int of_mdiobus_register_phy(struct mii_bus *mdio,
> -				    struct device_node *child, u32 addr)
> +int __of_mdiobus_register_phy(struct mii_bus *mdio, struct phy_device *phy,
> +			      struct device_node *child, u32 addr)
>  {
> -	struct mii_timestamper *mii_ts;
> -	struct phy_device *phy;
> -	bool is_c45;
> -	int rc;
>  	u32 phy_id;

I need to remove phy_id here.

> -	mii_ts = of_find_mii_timestamper(child);
> -	if (IS_ERR(mii_ts))
> -		return PTR_ERR(mii_ts);
> -
> -	is_c45 = of_device_is_compatible(child,
> -					 "ethernet-phy-ieee802.3-c45");
> -
> -	if (!is_c45 && !of_get_phy_id(child, &phy_id))
> -		phy = phy_device_create(mdio, addr, phy_id, 0, NULL);
> -	else
> -		phy = get_phy_device(mdio, addr, is_c45);
> -	if (IS_ERR(phy)) {
> -		if (mii_ts)
> -			unregister_mii_timestamper(mii_ts);
> -		return PTR_ERR(phy);
> -	}
> +	int rc;
>  
>  	rc = of_irq_get(child, 0);
> -	if (rc == -EPROBE_DEFER) {
> -		if (mii_ts)
> -			unregister_mii_timestamper(mii_ts);
> -		phy_device_free(phy);
> +	if (rc == -EPROBE_DEFER)
>  		return rc;
> -	}
> +
>  	if (rc > 0) {
>  		phy->irq = rc;
>  		mdio->irq[addr] = rc;
> @@ -117,11 +94,48 @@ static int of_mdiobus_register_phy(struct mii_bus *mdio,
>  	/* All data is now stored in the phy struct;
>  	 * register it */
>  	rc = phy_device_register(phy);
> +	if (rc) {
> +		of_node_put(child);
> +		return rc;
> +	}
> +
> +	dev_dbg(&mdio->dev, "registered phy %pOFn at address %i\n",
> +		child, addr);
> +	return 0;
> +}
> +EXPORT_SYMBOL(__of_mdiobus_register_phy);
> +
> +static int of_mdiobus_register_phy(struct mii_bus *mdio,
> +				    struct device_node *child, u32 addr)
> +{
> +	struct mii_timestamper *mii_ts;
> +	struct phy_device *phy;
> +	bool is_c45;
> +	int rc;
> +	u32 phy_id;
> +
> +	mii_ts = of_find_mii_timestamper(child);
> +	if (IS_ERR(mii_ts))
> +		return PTR_ERR(mii_ts);
> +
> +	is_c45 = of_device_is_compatible(child,
> +					 "ethernet-phy-ieee802.3-c45");
> +
> +	if (!is_c45 && !of_get_phy_id(child, &phy_id))
> +		phy = phy_device_create(mdio, addr, phy_id, 0, NULL);
> +	else
> +		phy = get_phy_device(mdio, addr, is_c45);
> +	if (IS_ERR(phy)) {
> +		if (mii_ts)
> +			unregister_mii_timestamper(mii_ts);
> +		return PTR_ERR(phy);
> +	}
> +
> +	rc = __of_mdiobus_register_phy(mdio, phy, child, addr);
>  	if (rc) {
>  		if (mii_ts)
>  			unregister_mii_timestamper(mii_ts);
>  		phy_device_free(phy);
> -		of_node_put(child);
>  		return rc;
>  	}
>  
> @@ -132,8 +146,6 @@ static int of_mdiobus_register_phy(struct mii_bus *mdio,
>  	if (mii_ts)
>  		phy->mii_ts = mii_ts;
>  
> -	dev_dbg(&mdio->dev, "registered phy %pOFn at address %i\n",
> -		child, addr);
>  	return 0;
>  }
>  
> diff --git a/include/linux/of_mdio.h b/include/linux/of_mdio.h
> index 491a2b7e77c1..b99e9f932002 100644
> --- a/include/linux/of_mdio.h
> +++ b/include/linux/of_mdio.h
> @@ -30,7 +30,9 @@ extern struct mii_bus *of_mdio_find_bus(struct device_node *mdio_np);
>  extern int of_phy_register_fixed_link(struct device_node *np);
>  extern void of_phy_deregister_fixed_link(struct device_node *np);
>  extern bool of_phy_is_fixed_link(struct device_node *np);
> -
> +extern int __of_mdiobus_register_phy(struct mii_bus *mdio,
> +				     struct phy_device *phy,
> +				     struct device_node *child, u32 addr);
>  
>  static inline int of_mdio_parse_addr(struct device *dev,
>  				     const struct device_node *np)
> @@ -118,6 +120,13 @@ static inline bool of_phy_is_fixed_link(struct device_node *np)
>  {
>  	return false;
>  }
> +
> +static inline int __of_mdiobus_register_phy(struct mii_bus *mdio,
> +					    struct phy_device *phy,
> +					    struct device_node *child, u32 addr)
> +{
> +	return -ENOSYS;
> +}
>  #endif
>  
>  
> -- 
> 2.25.1
> 
> 

-- 
Pengutronix e.K.                           |                             |
Steuerwalder Str. 21                       | http://www.pengutronix.de/  |
31137 Hildesheim, Germany                  | Phone: +49-5121-206917-0    |
Amtsgericht Hildesheim, HRA 2686           | Fax:   +49-5121-206917-5555 |