drivers/net/dsa/realtek/rtl83xx.c - linux - Git at Google

 // SPDX-License-Identifier: GPL-2.0+

 #include <linux/module.h>
 #include <linux/regmap.h>
 #include <linux/of_mdio.h>

 #include "realtek.h"
 #include "rtl83xx.h"

 /**
  * rtl83xx_lock() - Locks the mutex used by regmaps
  * @ctx: realtek_priv pointer
  *
  * This function is passed to regmap to be used as the lock function.
  * It is also used externally to block regmap before executing multiple
  * operations that must happen in sequence (which will use
  * realtek_priv.map_nolock instead).
  *
  * Context: Can sleep. Holds priv->map_lock lock.
  * Return: nothing
  */
 void rtl83xx_lock(void *ctx)
 {
 	struct realtek_priv *priv = ctx;

 	mutex_lock(&priv->map_lock);
 }
 EXPORT_SYMBOL_NS_GPL(rtl83xx_lock, REALTEK_DSA);

 /**
  * rtl83xx_unlock() - Unlocks the mutex used by regmaps
  * @ctx: realtek_priv pointer
  *
  * This function unlocks the lock acquired by rtl83xx_lock.
  *
  * Context: Releases priv->map_lock lock.
  * Return: nothing
  */
 void rtl83xx_unlock(void *ctx)
 {
 	struct realtek_priv *priv = ctx;

 	mutex_unlock(&priv->map_lock);
 }
 EXPORT_SYMBOL_NS_GPL(rtl83xx_unlock, REALTEK_DSA);

 static int rtl83xx_user_mdio_read(struct mii_bus *bus, int addr, int regnum)
 {
 	struct realtek_priv *priv = bus->priv;

 	return priv->ops->phy_read(priv, addr, regnum);
 }

 static int rtl83xx_user_mdio_write(struct mii_bus *bus, int addr, int regnum,
 				   u16 val)
 {
 	struct realtek_priv *priv = bus->priv;

 	return priv->ops->phy_write(priv, addr, regnum, val);
 }

 /**
  * rtl83xx_setup_user_mdio() - register the user mii bus driver
  * @ds: DSA switch associated with this user_mii_bus
  *
  * Registers the MDIO bus for built-in Ethernet PHYs, and associates it with
  * the mandatory 'mdio' child OF node of the switch.
  *
  * Context: Can sleep.
  * Return: 0 on success, negative value for failure.
  */
 int rtl83xx_setup_user_mdio(struct dsa_switch *ds)
 {
 	struct realtek_priv *priv = ds->priv;
 	struct device_node *mdio_np;
 	struct mii_bus *bus;
 	int ret = 0;

 	mdio_np = of_get_child_by_name(priv->dev->of_node, "mdio");
 	if (!mdio_np) {
 		dev_err(priv->dev, "no MDIO bus node\n");
 		return -ENODEV;
 	}

 	bus = devm_mdiobus_alloc(priv->dev);
 	if (!bus) {
 		ret = -ENOMEM;
 		goto err_put_node;
 	}

 	bus->priv = priv;
 	bus->name = "Realtek user MII";
 	bus->read = rtl83xx_user_mdio_read;
 	bus->write = rtl83xx_user_mdio_write;
 	snprintf(bus->id, MII_BUS_ID_SIZE, "%s:user_mii", dev_name(priv->dev));
 	bus->parent = priv->dev;

 	ret = devm_of_mdiobus_register(priv->dev, bus, mdio_np);
 	if (ret) {
 		dev_err(priv->dev, "unable to register MDIO bus %s\n",
 			bus->id);
 		goto err_put_node;
 	}

 	priv->user_mii_bus = bus;

 err_put_node:
 	of_node_put(mdio_np);

 	return ret;
 }
 EXPORT_SYMBOL_NS_GPL(rtl83xx_setup_user_mdio, REALTEK_DSA);

 /**
  * rtl83xx_probe() - probe a Realtek switch
  * @dev: the device being probed
  * @interface_info: specific management interface info.
  *
  * This function initializes realtek_priv and reads data from the device tree
  * node. The switch is hard resetted if a method is provided.
  *
  * Context: Can sleep.
  * Return: Pointer to the realtek_priv or ERR_PTR() in case of failure.
  *
  * The realtek_priv pointer does not need to be freed as it is controlled by
  * devres.
  */
 struct realtek_priv *
 rtl83xx_probe(struct device *dev,
 	      const struct realtek_interface_info *interface_info)
 {
 	const struct realtek_variant *var;
 	struct realtek_priv *priv;
 	struct regmap_config rc = {
 		.reg_bits = 10, /* A4..A0 R4..R0 */
 		.val_bits = 16,
 		.reg_stride = 1,
 		.max_register = 0xffff,
 		.reg_format_endian = REGMAP_ENDIAN_BIG,
 		.reg_read = interface_info->reg_read,
 		.reg_write = interface_info->reg_write,
 		.cache_type = REGCACHE_NONE,
 		.lock = rtl83xx_lock,
 		.unlock = rtl83xx_unlock,
 	};
 	int ret;

 	var = of_device_get_match_data(dev);
 	if (!var)
 		return ERR_PTR(-EINVAL);

 	priv = devm_kzalloc(dev, size_add(sizeof(*priv), var->chip_data_sz),
 			    GFP_KERNEL);
 	if (!priv)
 		return ERR_PTR(-ENOMEM);

 	mutex_init(&priv->map_lock);

 	rc.lock_arg = priv;
 	priv->map = devm_regmap_init(dev, NULL, priv, &rc);
 	if (IS_ERR(priv->map)) {
 		ret = PTR_ERR(priv->map);
 		dev_err(dev, "regmap init failed: %d\n", ret);
 		return ERR_PTR(ret);
 	}

 	rc.disable_locking = true;
 	priv->map_nolock = devm_regmap_init(dev, NULL, priv, &rc);
 	if (IS_ERR(priv->map_nolock)) {
 		ret = PTR_ERR(priv->map_nolock);
 		dev_err(dev, "regmap init failed: %d\n", ret);
 		return ERR_PTR(ret);
 	}

 	/* Link forward and backward */
 	priv->dev = dev;
 	priv->variant = var;
 	priv->ops = var->ops;
 	priv->chip_data = (void *)priv + sizeof(*priv);

 	spin_lock_init(&priv->lock);

 	priv->leds_disabled = of_property_read_bool(dev->of_node,
 						    "realtek,disable-leds");

 	/* TODO: if power is software controlled, set up any regulators here */
 	priv->reset_ctl = devm_reset_control_get_optional(dev, NULL);
 	if (IS_ERR(priv->reset_ctl))
 		return dev_err_cast_probe(dev, priv->reset_ctl,
 					  "failed to get reset control\n");

 	priv->reset = devm_gpiod_get_optional(dev, "reset", GPIOD_OUT_LOW);
 	if (IS_ERR(priv->reset)) {
 		dev_err(dev, "failed to get RESET GPIO\n");
 		return ERR_CAST(priv->reset);
 	}

 	dev_set_drvdata(dev, priv);

 	if (priv->reset_ctl || priv->reset) {
 		rtl83xx_reset_assert(priv);
 		dev_dbg(dev, "asserted RESET\n");
 		msleep(REALTEK_HW_STOP_DELAY);
 		rtl83xx_reset_deassert(priv);
 		msleep(REALTEK_HW_START_DELAY);
 		dev_dbg(dev, "deasserted RESET\n");
 	}

 	return priv;
 }
 EXPORT_SYMBOL_NS_GPL(rtl83xx_probe, REALTEK_DSA);

 /**
  * rtl83xx_register_switch() - detects and register a switch
  * @priv: realtek_priv pointer
  *
  * This function first checks the switch chip ID and register a DSA
  * switch.
  *
  * Context: Can sleep. Takes and releases priv->map_lock.
  * Return: 0 on success, negative value for failure.
  */
 int rtl83xx_register_switch(struct realtek_priv *priv)
 {
 	struct dsa_switch *ds = &priv->ds;
 	int ret;

 	ret = priv->ops->detect(priv);
 	if (ret) {
 		dev_err_probe(priv->dev, ret, "unable to detect switch\n");
 		return ret;
 	}

 	ds->priv = priv;
 	ds->dev = priv->dev;
 	ds->ops = priv->variant->ds_ops;
 	ds->phylink_mac_ops = priv->variant->phylink_mac_ops;
 	ds->num_ports = priv->num_ports;

 	ret = dsa_register_switch(ds);
 	if (ret) {
 		dev_err_probe(priv->dev, ret, "unable to register switch\n");
 		return ret;
 	}

 	return 0;
 }
 EXPORT_SYMBOL_NS_GPL(rtl83xx_register_switch, REALTEK_DSA);

 /**
  * rtl83xx_unregister_switch() - unregister a switch
  * @priv: realtek_priv pointer
  *
  * This function unregister a DSA switch.
  *
  * Context: Can sleep.
  * Return: Nothing.
  */
 void rtl83xx_unregister_switch(struct realtek_priv *priv)
 {
 	struct dsa_switch *ds = &priv->ds;

 	dsa_unregister_switch(ds);
 }
 EXPORT_SYMBOL_NS_GPL(rtl83xx_unregister_switch, REALTEK_DSA);

 /**
  * rtl83xx_shutdown() - shutdown a switch
  * @priv: realtek_priv pointer
  *
  * This function shuts down the DSA switch and cleans the platform driver data,
  * to prevent realtek_{smi,mdio}_remove() from running afterwards, which is
  * possible if the parent bus implements its own .shutdown() as .remove().
  *
  * Context: Can sleep.
  * Return: Nothing.
  */
 void rtl83xx_shutdown(struct realtek_priv *priv)
 {
 	struct dsa_switch *ds = &priv->ds;

 	dsa_switch_shutdown(ds);

 	dev_set_drvdata(priv->dev, NULL);
 }
 EXPORT_SYMBOL_NS_GPL(rtl83xx_shutdown, REALTEK_DSA);

 /**
  * rtl83xx_remove() - Cleanup a realtek switch driver
  * @priv: realtek_priv pointer
  *
  * Placehold for common cleanup procedures.
  *
  * Context: Any
  * Return: nothing
  */
 void rtl83xx_remove(struct realtek_priv *priv)
 {
 }
 EXPORT_SYMBOL_NS_GPL(rtl83xx_remove, REALTEK_DSA);

 void rtl83xx_reset_assert(struct realtek_priv *priv)
 {
 	int ret;

 	ret = reset_control_assert(priv->reset_ctl);
 	if (ret)
 		dev_warn(priv->dev,
 			 "Failed to assert the switch reset control: %pe\n",
 			 ERR_PTR(ret));

 	gpiod_set_value(priv->reset, true);
 }

 void rtl83xx_reset_deassert(struct realtek_priv *priv)
 {
 	int ret;

 	ret = reset_control_deassert(priv->reset_ctl);
 	if (ret)
 		dev_warn(priv->dev,
 			 "Failed to deassert the switch reset control: %pe\n",
 			 ERR_PTR(ret));

 	gpiod_set_value(priv->reset, false);
 }

 MODULE_AUTHOR("Luiz Angelo Daros de Luca <luizluca@gmail.com>");
 MODULE_AUTHOR("Linus Walleij <linus.walleij@linaro.org>");
 MODULE_DESCRIPTION("Realtek DSA switches common module");
 MODULE_LICENSE("GPL");
	// SPDX-License-Identifier: GPL-2.0+

	#include <linux/module.h>
	#include <linux/regmap.h>
	#include <linux/of_mdio.h>

	#include "realtek.h"
	#include "rtl83xx.h"

	/**
	* rtl83xx_lock() - Locks the mutex used by regmaps
	* @ctx: realtek_priv pointer
	*
	* This function is passed to regmap to be used as the lock function.
	* It is also used externally to block regmap before executing multiple
	* operations that must happen in sequence (which will use
	* realtek_priv.map_nolock instead).
	*
	* Context: Can sleep. Holds priv->map_lock lock.
	* Return: nothing
	*/
	void rtl83xx_lock(void *ctx)
	{
	struct realtek_priv *priv = ctx;

	mutex_lock(&priv->map_lock);
	}
	EXPORT_SYMBOL_NS_GPL(rtl83xx_lock, REALTEK_DSA);

	/**
	* rtl83xx_unlock() - Unlocks the mutex used by regmaps
	* @ctx: realtek_priv pointer
	*
	* This function unlocks the lock acquired by rtl83xx_lock.
	*
	* Context: Releases priv->map_lock lock.
	* Return: nothing
	*/
	void rtl83xx_unlock(void *ctx)
	{
	struct realtek_priv *priv = ctx;

	mutex_unlock(&priv->map_lock);
	}
	EXPORT_SYMBOL_NS_GPL(rtl83xx_unlock, REALTEK_DSA);

	static int rtl83xx_user_mdio_read(struct mii_bus *bus, int addr, int regnum)
	{
	struct realtek_priv *priv = bus->priv;

	return priv->ops->phy_read(priv, addr, regnum);
	}

	static int rtl83xx_user_mdio_write(struct mii_bus *bus, int addr, int regnum,
	u16 val)
	{
	struct realtek_priv *priv = bus->priv;

	return priv->ops->phy_write(priv, addr, regnum, val);
	}

	/**
	* rtl83xx_setup_user_mdio() - register the user mii bus driver
	* @ds: DSA switch associated with this user_mii_bus
	*
	* Registers the MDIO bus for built-in Ethernet PHYs, and associates it with
	* the mandatory 'mdio' child OF node of the switch.
	*
	* Context: Can sleep.
	* Return: 0 on success, negative value for failure.
	*/
	int rtl83xx_setup_user_mdio(struct dsa_switch *ds)
	{
	struct realtek_priv *priv = ds->priv;
	struct device_node *mdio_np;
	struct mii_bus *bus;
	int ret = 0;

	mdio_np = of_get_child_by_name(priv->dev->of_node, "mdio");
	if (!mdio_np) {
	dev_err(priv->dev, "no MDIO bus node\n");
	return -ENODEV;
	}

	bus = devm_mdiobus_alloc(priv->dev);
	if (!bus) {
	ret = -ENOMEM;
	goto err_put_node;
	}

	bus->priv = priv;
	bus->name = "Realtek user MII";
	bus->read = rtl83xx_user_mdio_read;
	bus->write = rtl83xx_user_mdio_write;
	snprintf(bus->id, MII_BUS_ID_SIZE, "%s:user_mii", dev_name(priv->dev));
	bus->parent = priv->dev;

	ret = devm_of_mdiobus_register(priv->dev, bus, mdio_np);
	if (ret) {
	dev_err(priv->dev, "unable to register MDIO bus %s\n",
	bus->id);
	goto err_put_node;
	}

	priv->user_mii_bus = bus;

	err_put_node:
	of_node_put(mdio_np);

	return ret;
	}
	EXPORT_SYMBOL_NS_GPL(rtl83xx_setup_user_mdio, REALTEK_DSA);

	/**
	* rtl83xx_probe() - probe a Realtek switch
	* @dev: the device being probed
	* @interface_info: specific management interface info.
	*
	* This function initializes realtek_priv and reads data from the device tree
	* node. The switch is hard resetted if a method is provided.
	*
	* Context: Can sleep.
	* Return: Pointer to the realtek_priv or ERR_PTR() in case of failure.
	*
	* The realtek_priv pointer does not need to be freed as it is controlled by
	* devres.
	*/
	struct realtek_priv *
	rtl83xx_probe(struct device *dev,
	const struct realtek_interface_info *interface_info)
	{
	const struct realtek_variant *var;
	struct realtek_priv *priv;
	struct regmap_config rc = {
	.reg_bits = 10, /* A4..A0 R4..R0 */
	.val_bits = 16,
	.reg_stride = 1,
	.max_register = 0xffff,
	.reg_format_endian = REGMAP_ENDIAN_BIG,
	.reg_read = interface_info->reg_read,
	.reg_write = interface_info->reg_write,
	.cache_type = REGCACHE_NONE,
	.lock = rtl83xx_lock,
	.unlock = rtl83xx_unlock,
	};
	int ret;

	var = of_device_get_match_data(dev);
	if (!var)
	return ERR_PTR(-EINVAL);

	priv = devm_kzalloc(dev, size_add(sizeof(*priv), var->chip_data_sz),
	GFP_KERNEL);
	if (!priv)
	return ERR_PTR(-ENOMEM);

	mutex_init(&priv->map_lock);

	rc.lock_arg = priv;
	priv->map = devm_regmap_init(dev, NULL, priv, &rc);
	if (IS_ERR(priv->map)) {
	ret = PTR_ERR(priv->map);
	dev_err(dev, "regmap init failed: %d\n", ret);
	return ERR_PTR(ret);
	}

	rc.disable_locking = true;
	priv->map_nolock = devm_regmap_init(dev, NULL, priv, &rc);
	if (IS_ERR(priv->map_nolock)) {
	ret = PTR_ERR(priv->map_nolock);
	dev_err(dev, "regmap init failed: %d\n", ret);
	return ERR_PTR(ret);
	}

	/* Link forward and backward */
	priv->dev = dev;
	priv->variant = var;
	priv->ops = var->ops;
	priv->chip_data = (void )priv + sizeof(priv);

	spin_lock_init(&priv->lock);

	priv->leds_disabled = of_property_read_bool(dev->of_node,
	"realtek,disable-leds");

	/* TODO: if power is software controlled, set up any regulators here */
	priv->reset_ctl = devm_reset_control_get_optional(dev, NULL);
	if (IS_ERR(priv->reset_ctl))
	return dev_err_cast_probe(dev, priv->reset_ctl,
	"failed to get reset control\n");

	priv->reset = devm_gpiod_get_optional(dev, "reset", GPIOD_OUT_LOW);
	if (IS_ERR(priv->reset)) {
	dev_err(dev, "failed to get RESET GPIO\n");
	return ERR_CAST(priv->reset);
	}

	dev_set_drvdata(dev, priv);

	if (priv->reset_ctl \|\| priv->reset) {
	rtl83xx_reset_assert(priv);
	dev_dbg(dev, "asserted RESET\n");
	msleep(REALTEK_HW_STOP_DELAY);
	rtl83xx_reset_deassert(priv);
	msleep(REALTEK_HW_START_DELAY);
	dev_dbg(dev, "deasserted RESET\n");
	}

	return priv;
	}
	EXPORT_SYMBOL_NS_GPL(rtl83xx_probe, REALTEK_DSA);

	/**
	* rtl83xx_register_switch() - detects and register a switch
	* @priv: realtek_priv pointer
	*
	* This function first checks the switch chip ID and register a DSA
	* switch.
	*
	* Context: Can sleep. Takes and releases priv->map_lock.
	* Return: 0 on success, negative value for failure.
	*/
	int rtl83xx_register_switch(struct realtek_priv *priv)
	{
	struct dsa_switch *ds = &priv->ds;
	int ret;

	ret = priv->ops->detect(priv);
	if (ret) {
	dev_err_probe(priv->dev, ret, "unable to detect switch\n");
	return ret;
	}

	ds->priv = priv;
	ds->dev = priv->dev;
	ds->ops = priv->variant->ds_ops;
	ds->phylink_mac_ops = priv->variant->phylink_mac_ops;
	ds->num_ports = priv->num_ports;

	ret = dsa_register_switch(ds);
	if (ret) {
	dev_err_probe(priv->dev, ret, "unable to register switch\n");
	return ret;
	}

	return 0;
	}
	EXPORT_SYMBOL_NS_GPL(rtl83xx_register_switch, REALTEK_DSA);

	/**
	* rtl83xx_unregister_switch() - unregister a switch
	* @priv: realtek_priv pointer
	*
	* This function unregister a DSA switch.
	*
	* Context: Can sleep.
	* Return: Nothing.
	*/
	void rtl83xx_unregister_switch(struct realtek_priv *priv)
	{
	struct dsa_switch *ds = &priv->ds;

	dsa_unregister_switch(ds);
	}
	EXPORT_SYMBOL_NS_GPL(rtl83xx_unregister_switch, REALTEK_DSA);

	/**
	* rtl83xx_shutdown() - shutdown a switch
	* @priv: realtek_priv pointer
	*
	* This function shuts down the DSA switch and cleans the platform driver data,
	* to prevent realtek_{smi,mdio}_remove() from running afterwards, which is
	* possible if the parent bus implements its own .shutdown() as .remove().
	*
	* Context: Can sleep.
	* Return: Nothing.
	*/
	void rtl83xx_shutdown(struct realtek_priv *priv)
	{
	struct dsa_switch *ds = &priv->ds;

	dsa_switch_shutdown(ds);

	dev_set_drvdata(priv->dev, NULL);
	}
	EXPORT_SYMBOL_NS_GPL(rtl83xx_shutdown, REALTEK_DSA);

	/**
	* rtl83xx_remove() - Cleanup a realtek switch driver
	* @priv: realtek_priv pointer
	*
	* Placehold for common cleanup procedures.
	*
	* Context: Any
	* Return: nothing
	*/
	void rtl83xx_remove(struct realtek_priv *priv)
	{
	}
	EXPORT_SYMBOL_NS_GPL(rtl83xx_remove, REALTEK_DSA);

	void rtl83xx_reset_assert(struct realtek_priv *priv)
	{
	int ret;

	ret = reset_control_assert(priv->reset_ctl);
	if (ret)
	dev_warn(priv->dev,
	"Failed to assert the switch reset control: %pe\n",
	ERR_PTR(ret));

	gpiod_set_value(priv->reset, true);
	}

	void rtl83xx_reset_deassert(struct realtek_priv *priv)
	{
	int ret;

	ret = reset_control_deassert(priv->reset_ctl);
	if (ret)
	dev_warn(priv->dev,
	"Failed to deassert the switch reset control: %pe\n",
	ERR_PTR(ret));

	gpiod_set_value(priv->reset, false);
	}

	MODULE_AUTHOR("Luiz Angelo Daros de Luca <luizluca@gmail.com>");
	MODULE_AUTHOR("Linus Walleij <linus.walleij@linaro.org>");
	MODULE_DESCRIPTION("Realtek DSA switches common module");
	MODULE_LICENSE("GPL");