target/linux/bmips/patches-5.10/501-net-dsa-b53-mmap-Add-device-tree-support.patch

   1 From f5419e7f362ae1c462baf28a2da7360267f8e4f9 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 07:32:32 +0100
   4 Subject: [PATCH 2/3] net: dsa: b53: mmap: Add device tree support
   5 MIME-Version: 1.0
   6 Content-Type: text/plain; charset=UTF-8
   7 Content-Transfer-Encoding: 8bit
   8
   9 Add device tree support to b53_mmap.c while keeping platform devices support.
  10
  11 Signed-off-by: Álvaro Fernández Rojas <noltari@gmail.com>
  12 ---
  13  drivers/net/dsa/b53/b53_mmap.c | 36 ++++++++++++++++++++++++++++++++++
  14  1 file changed, 36 insertions(+)
  15
  16 --- a/drivers/net/dsa/b53/b53_mmap.c
  17 +++ b/drivers/net/dsa/b53/b53_mmap.c
  18 @@ -228,12 +228,64 @@ static const struct b53_io_ops b53_mmap_
  19         .write64 = b53_mmap_write64,
  20  };
  21
  22 +static int b53_mmap_probe_of(struct platform_device *pdev,
  23 +                            struct b53_platform_data **ppdata)
  24 +{
  25 +       struct device *dev = &pdev->dev;
  26 +       struct device_node *np = dev->of_node;
  27 +       struct device_node *of_ports, *of_port;
  28 +       struct b53_platform_data *pdata;
  29 +       void __iomem *mem;
  30 +
  31 +       mem = devm_platform_ioremap_resource(pdev, 0);
  32 +       if (IS_ERR(mem))
  33 +               return PTR_ERR(mem);
  34 +
  35 +       pdata = devm_kzalloc(dev, sizeof(struct b53_platform_data),
  36 +                            GFP_KERNEL);
  37 +       if (!pdata)
  38 +               return -ENOMEM;
  39 +
  40 +       pdata->regs = mem;
  41 +       pdata->chip_id = BCM63XX_DEVICE_ID;
  42 +       pdata->big_endian = of_property_read_bool(np, "big-endian");
  43 +
  44 +       of_ports = of_get_child_by_name(np, "ports");
  45 +       if (!of_ports) {
  46 +               dev_err(dev, "no ports child node found\n");
  47 +               return -EINVAL;
  48 +       }
  49 +
  50 +       for_each_available_child_of_node(of_ports, of_port) {
  51 +               u32 reg;
  52 +
  53 +               if (of_property_read_u32(of_port, "reg", &reg))
  54 +                       continue;
  55 +
  56 +               if (reg < B53_CPU_PORT)
  57 +                       pdata->enabled_ports |= BIT(reg);
  58 +       }
  59 +
  60 +       *ppdata = pdata;
  61 +
  62 +       return 0;
  63 +}
  64 +
  65  static int b53_mmap_probe(struct platform_device *pdev)
  66  {
  67 +       struct device_node *np = pdev->dev.of_node;
  68         struct b53_platform_data *pdata = pdev->dev.platform_data;
  69         struct b53_mmap_priv *priv;
  70         struct b53_device *dev;
  71
  72 +       if (np) {
  73 +               int ret = b53_mmap_probe_of(pdev, &pdata);
  74 +               if (ret) {
  75 +                       dev_err(&pdev->dev, "OF probe error\n");
  76 +                       return ret;
  77 +               }
  78 +       }
  79 +
  80         if (!pdata)
  81                 return -EINVAL;
  82