Quelle  realtek-mdio.c   Sprache: C

// SPDX-License-Identifier: GPL-2.0+
/* Realtek MDIO interface driver
 *
 * ASICs we intend to support with this driver:
 *
 * RTL8366   - The original version, apparently
 * RTL8369   - Similar enough to have the same datsheet as RTL8366
 * RTL8366RB - Probably reads out "RTL8366 revision B", has a quite
 *             different register layout from the other two
 * RTL8366S  - Is this "RTL8366 super"?
 * RTL8367   - Has an OpenWRT driver as well
 * RTL8368S  - Seems to be an alternative name for RTL8366RB
 * RTL8370   - Also uses SMI
 *
 * Copyright (C) 2017 Linus Walleij <linus.walleij@linaro.org>
 * Copyright (C) 2010 Antti Seppälä <a.seppala@gmail.com>
 * Copyright (C) 2010 Roman Yeryomin <roman@advem.lv>
 * Copyright (C) 2011 Colin Leitner <colin.leitner@googlemail.com>
 * Copyright (C) 2009-2010 Gabor Juhos <juhosg@openwrt.org>
 */

#include <linux/module.h>
#include <linux/of.h>
#include <linux/overflow.h>
#include <linux/regmap.h>

#include "realtek.h"
#include "realtek-mdio.h"
#include "rtl83xx.h"

/* Read/write via mdiobus */
#define REALTEK_MDIO_CTRL0_REG  31
#define REALTEK_MDIO_START_REG  29
#define REALTEK_MDIO_CTRL1_REG  21
#define REALTEK_MDIO_ADDRESS_REG 23
#define REALTEK_MDIO_DATA_WRITE_REG 24
#define REALTEK_MDIO_DATA_READ_REG 25

#define REALTEK_MDIO_START_OP  0xFFFF
#define REALTEK_MDIO_ADDR_OP  0x000E
#define REALTEK_MDIO_READ_OP  0x0001
#define REALTEK_MDIO_WRITE_OP  0x0003

static int realtek_mdio_write(void *ctx, u32 reg, u32 val)
{
 struct realtek_priv *priv = ctx;
 struct mii_bus *bus = priv->bus;
 int ret;

 mutex_lock(&bus->mdio_lock);

 ret = bus->write(bus, priv->mdio_addr, REALTEK_MDIO_CTRL0_REG, REALTEK_MDIO_ADDR_OP);
 if (ret)
  goto out_unlock;

 ret = bus->write(bus, priv->mdio_addr, REALTEK_MDIO_ADDRESS_REG, reg);
 if (ret)
  goto out_unlock;

 ret = bus->write(bus, priv->mdio_addr, REALTEK_MDIO_DATA_WRITE_REG, val);
 if (ret)
  goto out_unlock;

 ret = bus->write(bus, priv->mdio_addr, REALTEK_MDIO_CTRL1_REG, REALTEK_MDIO_WRITE_OP);

out_unlock:
 mutex_unlock(&bus->mdio_lock);

 return ret;
}

static int realtek_mdio_read(void *ctx, u32 reg, u32 *val)
{
 struct realtek_priv *priv = ctx;
 struct mii_bus *bus = priv->bus;
 int ret;

 mutex_lock(&bus->mdio_lock);

 ret = bus->write(bus, priv->mdio_addr, REALTEK_MDIO_CTRL0_REG, REALTEK_MDIO_ADDR_OP);
 if (ret)
  goto out_unlock;

 ret = bus->write(bus, priv->mdio_addr, REALTEK_MDIO_ADDRESS_REG, reg);
 if (ret)
  goto out_unlock;

 ret = bus->write(bus, priv->mdio_addr, REALTEK_MDIO_CTRL1_REG, REALTEK_MDIO_READ_OP);
 if (ret)
  goto out_unlock;

 ret = bus->read(bus, priv->mdio_addr, REALTEK_MDIO_DATA_READ_REG);
 if (ret >= 0) {
  *val = ret;
  ret = 0;
 }

out_unlock:
 mutex_unlock(&bus->mdio_lock);

 return ret;
}

static const struct realtek_interface_info realtek_mdio_info = {
 .reg_read = realtek_mdio_read,
 .reg_write = realtek_mdio_write,
};

/**
 * realtek_mdio_probe() - Probe a platform device for an MDIO-connected switch
 * @mdiodev: mdio_device to probe on.
 *
 * This function should be used as the .probe in an mdio_driver. After
 * calling the common probe function for both interfaces, it initializes the
 * values specific for MDIO-connected devices. Finally, it calls a common
 * function to register the DSA switch.
 *
 * Context: Can sleep. Takes and releases priv->map_lock.
 * Return: Returns 0 on success, a negative error on failure.
 */
int realtek_mdio_probe(struct mdio_device *mdiodev)
{
 struct device *dev = &mdiodev->dev;
 struct realtek_priv *priv;
 int ret;

 priv = rtl83xx_probe(dev, &realtek_mdio_info);
 if (IS_ERR(priv))
  return PTR_ERR(priv);

 priv->bus = mdiodev->bus;
 priv->mdio_addr = mdiodev->addr;
 priv->write_reg_noack = realtek_mdio_write;

 ret = rtl83xx_register_switch(priv);
 if (ret) {
  rtl83xx_remove(priv);
  return ret;
 }

 return 0;
}
EXPORT_SYMBOL_NS_GPL(realtek_mdio_probe, "REALTEK_DSA");

/**
 * realtek_mdio_remove() - Remove the driver of an MDIO-connected switch
 * @mdiodev: mdio_device to be removed.
 *
 * This function should be used as the .remove in an mdio_driver. First
 * it unregisters the DSA switch and then it calls the common remove function.
 *
 * Context: Can sleep.
 * Return: Nothing.
 */
void realtek_mdio_remove(struct mdio_device *mdiodev)
{
 struct realtek_priv *priv = dev_get_drvdata(&mdiodev->dev);

 if (!priv)
  return;

 rtl83xx_unregister_switch(priv);

 rtl83xx_remove(priv);
}
EXPORT_SYMBOL_NS_GPL(realtek_mdio_remove, "REALTEK_DSA");

/**
 * realtek_mdio_shutdown() - Shutdown the driver of a MDIO-connected switch
 * @mdiodev: mdio_device shutting down.
 *
 * This function should be used as the .shutdown in a platform_driver. It calls
 * the common shutdown function.
 *
 * Context: Can sleep.
 * Return: Nothing.
 */
void realtek_mdio_shutdown(struct mdio_device *mdiodev)
{
 struct realtek_priv *priv = dev_get_drvdata(&mdiodev->dev);

 if (!priv)
  return;

 rtl83xx_shutdown(priv);
}
EXPORT_SYMBOL_NS_GPL(realtek_mdio_shutdown, "REALTEK_DSA");