target/linux/bmips/patches-5.10/055-v5.13-pinctrl-bcm-add-bcm63xx-base-code.patch

   1 From 132f95016db0a0a0659e99b471a7d3fd0c60f961 Mon Sep 17 00:00:00 2001
   2 From: =?UTF-8?q?=C3=81lvaro=20Fern=C3=A1ndez=20Rojas?= <noltari@gmail.com>
   3 Date: Wed, 24 Mar 2021 09:19:05 +0100
   4 Subject: [PATCH 04/22] pinctrl: bcm: add bcm63xx base code
   5 MIME-Version: 1.0
   6 Content-Type: text/plain; charset=UTF-8
   7 Content-Transfer-Encoding: 8bit
   8
   9 Add a helper for registering BCM63XX pin controllers.
  10
  11 Co-developed-by: Jonas Gorski <jonas.gorski@gmail.com>
  12 Signed-off-by: Jonas Gorski <jonas.gorski@gmail.com>
  13 Signed-off-by: Álvaro Fernández Rojas <noltari@gmail.com>
  14 Link: https://lore.kernel.org/r/20210324081923.20379-5-noltari@gmail.com
  15 Signed-off-by: Linus Walleij <linus.walleij@linaro.org>
  16 ---
  17  drivers/pinctrl/bcm/Kconfig           |   7 ++
  18  drivers/pinctrl/bcm/Makefile          |   1 +
  19  drivers/pinctrl/bcm/pinctrl-bcm63xx.c | 109 ++++++++++++++++++++++++++
  20  drivers/pinctrl/bcm/pinctrl-bcm63xx.h |  43 ++++++++++
  21  4 files changed, 160 insertions(+)
  22  create mode 100644 drivers/pinctrl/bcm/pinctrl-bcm63xx.c
  23  create mode 100644 drivers/pinctrl/bcm/pinctrl-bcm63xx.h
  24
  25 --- a/drivers/pinctrl/bcm/Kconfig
  26 +++ b/drivers/pinctrl/bcm/Kconfig
  27 @@ -29,6 +29,13 @@ config PINCTRL_BCM2835
  28         help
  29            Say Y here to enable the Broadcom BCM2835 GPIO driver.
  30
  31 +config PINCTRL_BCM63XX
  32 +       bool
  33 +       select GENERIC_PINCONF
  34 +       select GPIO_REGMAP
  35 +       select PINCONF
  36 +       select PINMUX
  37 +
  38  config PINCTRL_IPROC_GPIO
  39         bool "Broadcom iProc GPIO (with PINCONF) driver"
  40         depends on OF_GPIO && (ARCH_BCM_IPROC || COMPILE_TEST)
  41 --- a/drivers/pinctrl/bcm/Makefile
  42 +++ b/drivers/pinctrl/bcm/Makefile
  43 @@ -3,6 +3,7 @@
  44
  45  obj-$(CONFIG_PINCTRL_BCM281XX)         += pinctrl-bcm281xx.o
  46  obj-$(CONFIG_PINCTRL_BCM2835)          += pinctrl-bcm2835.o
  47 +obj-$(CONFIG_PINCTRL_BCM63XX)          += pinctrl-bcm63xx.o
  48  obj-$(CONFIG_PINCTRL_IPROC_GPIO)       += pinctrl-iproc-gpio.o
  49  obj-$(CONFIG_PINCTRL_CYGNUS_MUX)       += pinctrl-cygnus-mux.o
  50  obj-$(CONFIG_PINCTRL_NS)               += pinctrl-ns.o
  51 --- /dev/null
  52 +++ b/drivers/pinctrl/bcm/pinctrl-bcm63xx.c
  53 @@ -0,0 +1,109 @@
  54 +// SPDX-License-Identifier: GPL-2.0+
  55 +/*
  56 + * Driver for BCM63xx GPIO unit (pinctrl + GPIO)
  57 + *
  58 + * Copyright (C) 2021 Álvaro Fernández Rojas <noltari@gmail.com>
  59 + * Copyright (C) 2016 Jonas Gorski <jonas.gorski@gmail.com>
  60 + */
  61 +
  62 +#include <linux/gpio/regmap.h>
  63 +#include <linux/mfd/syscon.h>
  64 +#include <linux/mod_devicetable.h>
  65 +#include <linux/of.h>
  66 +#include <linux/platform_device.h>
  67 +
  68 +#include "pinctrl-bcm63xx.h"
  69 +
  70 +#define BCM63XX_BANK_SIZE      4
  71 +
  72 +#define BCM63XX_DIROUT_REG     0x04
  73 +#define BCM63XX_DATA_REG       0x0c
  74 +
  75 +static int bcm63xx_reg_mask_xlate(struct gpio_regmap *gpio,
  76 +                                 unsigned int base, unsigned int offset,
  77 +                                 unsigned int *reg, unsigned int *mask)
  78 +{
  79 +       unsigned int line = offset % BCM63XX_BANK_GPIOS;
  80 +       unsigned int stride = offset / BCM63XX_BANK_GPIOS;
  81 +
  82 +       *reg = base - stride * BCM63XX_BANK_SIZE;
  83 +       *mask = BIT(line);
  84 +
  85 +       return 0;
  86 +}
  87 +
  88 +static const struct of_device_id bcm63xx_gpio_of_match[] = {
  89 +       { .compatible = "brcm,bcm6318-gpio", },
  90 +       { .compatible = "brcm,bcm6328-gpio", },
  91 +       { .compatible = "brcm,bcm6358-gpio", },
  92 +       { .compatible = "brcm,bcm6362-gpio", },
  93 +       { .compatible = "brcm,bcm6368-gpio", },
  94 +       { .compatible = "brcm,bcm63268-gpio", },
  95 +       { /* sentinel */ }
  96 +};
  97 +
  98 +static int bcm63xx_gpio_probe(struct device *dev, struct device_node *node,
  99 +                             const struct bcm63xx_pinctrl_soc *soc,
 100 +                             struct bcm63xx_pinctrl *pc)
 101 +{
 102 +       struct gpio_regmap_config grc = {0};
 103 +
 104 +       grc.parent = dev;
 105 +       grc.fwnode = &node->fwnode;
 106 +       grc.ngpio = soc->ngpios;
 107 +       grc.ngpio_per_reg = BCM63XX_BANK_GPIOS;
 108 +       grc.regmap = pc->regs;
 109 +       grc.reg_dat_base = BCM63XX_DATA_REG;
 110 +       grc.reg_dir_out_base = BCM63XX_DIROUT_REG;
 111 +       grc.reg_set_base = BCM63XX_DATA_REG;
 112 +       grc.reg_mask_xlate = bcm63xx_reg_mask_xlate;
 113 +
 114 +       return PTR_ERR_OR_ZERO(devm_gpio_regmap_register(dev, &grc));
 115 +}
 116 +
 117 +int bcm63xx_pinctrl_probe(struct platform_device *pdev,
 118 +                         const struct bcm63xx_pinctrl_soc *soc,
 119 +                         void *driver_data)
 120 +{
 121 +       struct device *dev = &pdev->dev;
 122 +       struct bcm63xx_pinctrl *pc;
 123 +       struct device_node *node;
 124 +       int err;
 125 +
 126 +       pc = devm_kzalloc(dev, sizeof(*pc), GFP_KERNEL);
 127 +       if (!pc)
 128 +               return -ENOMEM;
 129 +
 130 +       platform_set_drvdata(pdev, pc);
 131 +
 132 +       pc->dev = dev;
 133 +       pc->driver_data = driver_data;
 134 +
 135 +       pc->regs = syscon_node_to_regmap(dev->parent->of_node);
 136 +       if (IS_ERR(pc->regs))
 137 +               return PTR_ERR(pc->regs);
 138 +
 139 +       pc->pctl_desc.name = dev_name(dev);
 140 +       pc->pctl_desc.pins = soc->pins;
 141 +       pc->pctl_desc.npins = soc->npins;
 142 +       pc->pctl_desc.pctlops = soc->pctl_ops;
 143 +       pc->pctl_desc.pmxops = soc->pmx_ops;
 144 +       pc->pctl_desc.owner = THIS_MODULE;
 145 +
 146 +       pc->pctl_dev = devm_pinctrl_register(dev, &pc->pctl_desc, pc);
 147 +       if (IS_ERR(pc->pctl_dev))
 148 +               return PTR_ERR(pc->pctl_dev);
 149 +
 150 +       for_each_child_of_node(dev->parent->of_node, node) {
 151 +               if (of_match_node(bcm63xx_gpio_of_match, node)) {
 152 +                       err = bcm63xx_gpio_probe(dev, node, soc, pc);
 153 +                       if (err) {
 154 +                               dev_err(dev, "could not add GPIO chip\n");
 155 +                               of_node_put(node);
 156 +                               return err;
 157 +                       }
 158 +               }
 159 +       }
 160 +
 161 +       return 0;
 162 +}
 163 --- /dev/null
 164 +++ b/drivers/pinctrl/bcm/pinctrl-bcm63xx.h
 165 @@ -0,0 +1,43 @@
 166 +// SPDX-License-Identifier: GPL-2.0+
 167 +/*
 168 + * Copyright (C) 2021 Álvaro Fernández Rojas <noltari@gmail.com>
 169 + * Copyright (C) 2016 Jonas Gorski <jonas.gorski@gmail.com>
 170 + */
 171 +
 172 +#ifndef __PINCTRL_BCM63XX_H__
 173 +#define __PINCTRL_BCM63XX_H__
 174 +
 175 +#include <linux/pinctrl/pinctrl.h>
 176 +
 177 +#define BCM63XX_BANK_GPIOS 32
 178 +
 179 +struct bcm63xx_pinctrl_soc {
 180 +       struct pinctrl_ops *pctl_ops;
 181 +       struct pinmux_ops *pmx_ops;
 182 +
 183 +       const struct pinctrl_pin_desc *pins;
 184 +       unsigned npins;
 185 +
 186 +       unsigned int ngpios;
 187 +};
 188 +
 189 +struct bcm63xx_pinctrl {
 190 +       struct device *dev;
 191 +       struct regmap *regs;
 192 +
 193 +       struct pinctrl_desc pctl_desc;
 194 +       struct pinctrl_dev *pctl_dev;
 195 +
 196 +       void *driver_data;
 197 +};
 198 +
 199 +static inline unsigned int bcm63xx_bank_pin(unsigned int pin)
 200 +{
 201 +       return pin % BCM63XX_BANK_GPIOS;
 202 +}
 203 +
 204 +int bcm63xx_pinctrl_probe(struct platform_device *pdev,
 205 +                         const struct bcm63xx_pinctrl_soc *soc,
 206 +                         void *driver_data);
 207 +
 208 +#endif /* __PINCTRL_BCM63XX_H__ */