target/linux/bmips/patches-5.10/504-net-mdio-Add-BCM6368-MDIO-mux-bus-controller.patch

   1 From b6ecb2bca2b8ff80ae4b1b15f09dcf071f4ceaf4 Mon Sep 17 00:00:00 2001
   2 From: =?UTF-8?q?=C3=81lvaro=20Fern=C3=A1ndez=20Rojas?= <noltari@gmail.com>
   3 Date: Mon, 1 Mar 2021 16:42:12 +0100
   4 Subject: [PATCH] net: mdio: Add BCM6368 MDIO mux bus controller
   5 MIME-Version: 1.0
   6 Content-Type: text/plain; charset=UTF-8
   7 Content-Transfer-Encoding: 8bit
   8
   9 This controller is present on BCM6318, BCM6328, BCM6362, BCM6368 and BCM63268
  10 SoCs.
  11
  12 Signed-off-by: Álvaro Fernández Rojas <noltari@gmail.com>
  13 ---
  14  drivers/net/mdio/Kconfig            |  11 ++
  15  drivers/net/mdio/Makefile           |   1 +
  16  drivers/net/mdio/mdio-mux-bcm6368.c | 179 ++++++++++++++++++++++++++++
  17  3 files changed, 191 insertions(+)
  18  create mode 100644 drivers/net/mdio/mdio-mux-bcm6368.c
  19
  20 --- a/drivers/net/mdio/Kconfig
  21 +++ b/drivers/net/mdio/Kconfig
  22 @@ -200,6 +200,17 @@ config MDIO_BUS_MUX_MESON_G12A
  23           the amlogic g12a SoC. The multiplexers connects either the external
  24           or the internal MDIO bus to the parent bus.
  25
  26 +config MDIO_BUS_MUX_BCM6368
  27 +       tristate "Broadcom BCM6368 MDIO bus multiplexers"
  28 +       depends on OF && OF_MDIO && (BMIPS_GENERIC || COMPILE_TEST)
  29 +       select MDIO_BUS_MUX
  30 +       default BMIPS_GENERIC
  31 +       help
  32 +         This module provides a driver for MDIO bus multiplexers found in
  33 +         BCM6368 based Broadcom SoCs. This multiplexer connects one of several
  34 +         child MDIO bus to a parent bus. Buses could be internal as well as
  35 +         external and selection logic lies inside the same multiplexer.
  36 +
  37  config MDIO_BUS_MUX_BCM_IPROC
  38         tristate "Broadcom iProc based MDIO bus multiplexers"
  39         depends on OF && OF_MDIO && (ARCH_BCM_IPROC || COMPILE_TEST)
  40 --- a/drivers/net/mdio/Makefile
  41 +++ b/drivers/net/mdio/Makefile
  42 @@ -22,6 +22,7 @@ obj-$(CONFIG_MDIO_THUNDER)            += mdio-thun
  43  obj-$(CONFIG_MDIO_XGENE)               += mdio-xgene.o
  44
  45  obj-$(CONFIG_MDIO_BUS_MUX)             += mdio-mux.o
  46 +obj-$(CONFIG_MDIO_BUS_MUX_BCM6368)     += mdio-mux-bcm6368.o
  47  obj-$(CONFIG_MDIO_BUS_MUX_BCM_IPROC)   += mdio-mux-bcm-iproc.o
  48  obj-$(CONFIG_MDIO_BUS_MUX_GPIO)                += mdio-mux-gpio.o
  49  obj-$(CONFIG_MDIO_BUS_MUX_MESON_G12A)  += mdio-mux-meson-g12a.o
  50 --- /dev/null
  51 +++ b/drivers/net/mdio/mdio-mux-bcm6368.c
  52 @@ -0,0 +1,179 @@
  53 +// SPDX-License-Identifier: GPL-2.0+
  54 +/*
  55 + * Broadcom BCM6368 mdiomux bus controller driver
  56 + *
  57 + * Copyright (C) 2021 Álvaro Fernández Rojas <noltari@gmail.com>
  58 + */
  59 +
  60 +#include <linux/delay.h>
  61 +#include <linux/io.h>
  62 +#include <linux/kernel.h>
  63 +#include <linux/mdio-mux.h>
  64 +#include <linux/module.h>
  65 +#include <linux/of.h>
  66 +#include <linux/of_platform.h>
  67 +#include <linux/of_mdio.h>
  68 +#include <linux/phy.h>
  69 +#include <linux/platform_device.h>
  70 +#include <linux/sched.h>
  71 +
  72 +#define MDIOC_REG              0x0
  73 +#define MDIOC_EXT_MASK         BIT(16)
  74 +#define MDIOC_REG_SHIFT                20
  75 +#define MDIOC_PHYID_SHIFT      25
  76 +#define MDIOC_RD_MASK          BIT(30)
  77 +#define MDIOC_WR_MASK          BIT(31)
  78 +
  79 +#define MDIOD_REG              0x4
  80 +
  81 +struct bcm6368_mdiomux_desc {
  82 +       void *mux_handle;
  83 +       void __iomem *base;
  84 +       struct device *dev;
  85 +       struct mii_bus *mii_bus;
  86 +       int ext_phy;
  87 +};
  88 +
  89 +static int bcm6368_mdiomux_read(struct mii_bus *bus, int phy_id, int loc)
  90 +{
  91 +       struct bcm6368_mdiomux_desc *md = bus->priv;
  92 +       uint32_t reg;
  93 +       int ret;
  94 +
  95 +       __raw_writel(0, md->base + MDIOC_REG);
  96 +
  97 +       reg = MDIOC_RD_MASK |
  98 +             (phy_id << MDIOC_PHYID_SHIFT) |
  99 +             (loc << MDIOC_REG_SHIFT);
 100 +       if (md->ext_phy)
 101 +               reg |= MDIOC_EXT_MASK;
 102 +
 103 +       __raw_writel(reg, md->base + MDIOC_REG);
 104 +       udelay(50);
 105 +       ret = __raw_readw(md->base + MDIOD_REG);
 106 +
 107 +       return ret;
 108 +}
 109 +
 110 +static int bcm6368_mdiomux_write(struct mii_bus *bus, int phy_id, int loc,
 111 +                                uint16_t val)
 112 +{
 113 +       struct bcm6368_mdiomux_desc *md = bus->priv;
 114 +       uint32_t reg;
 115 +
 116 +       __raw_writel(0, md->base + MDIOC_REG);
 117 +
 118 +       reg = MDIOC_WR_MASK |
 119 +             (phy_id << MDIOC_PHYID_SHIFT) |
 120 +             (loc << MDIOC_REG_SHIFT);
 121 +       if (md->ext_phy)
 122 +               reg |= MDIOC_EXT_MASK;
 123 +       reg |= val;
 124 +
 125 +       __raw_writel(reg, md->base + MDIOC_REG);
 126 +       udelay(50);
 127 +
 128 +       return 0;
 129 +}
 130 +
 131 +static int bcm6368_mdiomux_switch_fn(int current_child, int desired_child,
 132 +                                    void *data)
 133 +{
 134 +       struct bcm6368_mdiomux_desc *md = data;
 135 +
 136 +       md->ext_phy = desired_child;
 137 +
 138 +       return 0;
 139 +}
 140 +
 141 +static int bcm6368_mdiomux_probe(struct platform_device *pdev)
 142 +{
 143 +       struct bcm6368_mdiomux_desc *md;
 144 +       struct mii_bus *bus;
 145 +       struct resource *res;
 146 +       int rc;
 147 +
 148 +       md = devm_kzalloc(&pdev->dev, sizeof(*md), GFP_KERNEL);
 149 +       if (!md)
 150 +               return -ENOMEM;
 151 +       md->dev = &pdev->dev;
 152 +
 153 +       res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
 154 +       if (!res)
 155 +               return -EINVAL;
 156 +
 157 +       /* Just ioremap, as this MDIO block is usually integrated into an
 158 +        * Ethernet MAC controller register range
 159 +        */
 160 +       md->base = devm_ioremap(&pdev->dev, res->start, resource_size(res));
 161 +       if (!md->base) {
 162 +               dev_err(&pdev->dev, "failed to ioremap register\n");
 163 +               return -ENOMEM;
 164 +       }
 165 +
 166 +       md->mii_bus = devm_mdiobus_alloc(&pdev->dev);
 167 +       if (!md->mii_bus) {
 168 +               dev_err(&pdev->dev, "mdiomux bus alloc failed\n");
 169 +               return ENOMEM;
 170 +       }
 171 +
 172 +       bus = md->mii_bus;
 173 +       bus->priv = md;
 174 +       bus->name = "BCM6368 MDIO mux bus";
 175 +       snprintf(bus->id, MII_BUS_ID_SIZE, "%s-%d", pdev->name, pdev->id);
 176 +       bus->parent = &pdev->dev;
 177 +       bus->read = bcm6368_mdiomux_read;
 178 +       bus->write = bcm6368_mdiomux_write;
 179 +       bus->phy_mask = 0x3f;
 180 +       bus->dev.of_node = pdev->dev.of_node;
 181 +
 182 +       rc = mdiobus_register(bus);
 183 +       if (rc) {
 184 +               dev_err(&pdev->dev, "mdiomux registration failed\n");
 185 +               return rc;
 186 +       }
 187 +
 188 +       platform_set_drvdata(pdev, md);
 189 +
 190 +       rc = mdio_mux_init(md->dev, md->dev->of_node,
 191 +                          bcm6368_mdiomux_switch_fn, &md->mux_handle, md,
 192 +                          md->mii_bus);
 193 +       if (rc) {
 194 +               dev_info(md->dev, "mdiomux initialization failed\n");
 195 +               goto out_register;
 196 +       }
 197 +
 198 +       dev_info(&pdev->dev, "Broadcom BCM6368 MDIO mux bus\n");
 199 +
 200 +       return 0;
 201 +
 202 +out_register:
 203 +       mdiobus_unregister(bus);
 204 +       return rc;
 205 +}
 206 +
 207 +static int bcm6368_mdiomux_remove(struct platform_device *pdev)
 208 +{
 209 +       struct bcm6368_mdiomux_desc *md = platform_get_drvdata(pdev);
 210 +
 211 +       mdio_mux_uninit(md->mux_handle);
 212 +       mdiobus_unregister(md->mii_bus);
 213 +
 214 +       return 0;
 215 +}
 216 +
 217 +static const struct of_device_id bcm6368_mdiomux_ids[] = {
 218 +       { .compatible = "brcm,bcm6368-mdio-mux", },
 219 +       { /* sentinel */ }
 220 +};
 221 +MODULE_DEVICE_TABLE(of, bcm6368_mdiomux_ids);
 222 +
 223 +static struct platform_driver bcm6368_mdiomux_driver = {
 224 +       .driver = {
 225 +               .name = "bcm6368-mdio-mux",
 226 +               .of_match_table = bcm6368_mdiomux_ids,
 227 +       },
 228 +       .probe  = bcm6368_mdiomux_probe,
 229 +       .remove = bcm6368_mdiomux_remove,
 230 +};
 231 +module_platform_driver(bcm6368_mdiomux_driver);