pinctrl/bcm/pinctrl-bcm63xx.c

0001 // SPDX-License-Identifier: GPL-2.0+
0002 /*
0003  * Driver for BCM63xx GPIO unit (pinctrl + GPIO)
0004  *
0005  * Copyright (C) 2021 Álvaro Fernández Rojas <noltari@gmail.com>
0006  * Copyright (C) 2016 Jonas Gorski <jonas.gorski@gmail.com>
0007  */
0008
0009 #include <linux/gpio/regmap.h>
0010 #include <linux/mfd/syscon.h>
0011 #include <linux/mod_devicetable.h>
0012 #include <linux/of.h>
0013 #include <linux/platform_device.h>
0014
0015 #include "pinctrl-bcm63xx.h"
0016
0017 #define BCM63XX_BANK_SIZE   4
0018
0019 #define BCM63XX_DIROUT_REG  0x04
0020 #define BCM63XX_DATA_REG    0x0c
0021
0022 static int bcm63xx_reg_mask_xlate(struct gpio_regmap *gpio,
0023                   unsigned int base, unsigned int offset,
0024                   unsigned int *reg, unsigned int *mask)
0025 {
0026     unsigned int line = offset % BCM63XX_BANK_GPIOS;
0027     unsigned int stride = offset / BCM63XX_BANK_GPIOS;
0028
0029     *reg = base - stride * BCM63XX_BANK_SIZE;
0030     *mask = BIT(line);
0031
0032     return 0;
0033 }
0034
0035 static const struct of_device_id bcm63xx_gpio_of_match[] = {
0036     { .compatible = "brcm,bcm6318-gpio", },
0037     { .compatible = "brcm,bcm6328-gpio", },
0038     { .compatible = "brcm,bcm6358-gpio", },
0039     { .compatible = "brcm,bcm6362-gpio", },
0040     { .compatible = "brcm,bcm6368-gpio", },
0041     { .compatible = "brcm,bcm63268-gpio", },
0042     { /* sentinel */ }
0043 };
0044
0045 static int bcm63xx_gpio_probe(struct device *dev, struct device_node *node,
0046                   const struct bcm63xx_pinctrl_soc *soc,
0047                   struct bcm63xx_pinctrl *pc)
0048 {
0049     struct gpio_regmap_config grc = {0};
0050
0051     grc.parent = dev;
0052     grc.fwnode = &node->fwnode;
0053     grc.ngpio = soc->ngpios;
0054     grc.ngpio_per_reg = BCM63XX_BANK_GPIOS;
0055     grc.regmap = pc->regs;
0056     grc.reg_dat_base = BCM63XX_DATA_REG;
0057     grc.reg_dir_out_base = BCM63XX_DIROUT_REG;
0058     grc.reg_set_base = BCM63XX_DATA_REG;
0059     grc.reg_mask_xlate = bcm63xx_reg_mask_xlate;
0060
0061     return PTR_ERR_OR_ZERO(devm_gpio_regmap_register(dev, &grc));
0062 }
0063
0064 int bcm63xx_pinctrl_probe(struct platform_device *pdev,
0065               const struct bcm63xx_pinctrl_soc *soc,
0066               void *driver_data)
0067 {
0068     struct device *dev = &pdev->dev;
0069     struct bcm63xx_pinctrl *pc;
0070     struct device_node *node;
0071     int err;
0072
0073     pc = devm_kzalloc(dev, sizeof(*pc), GFP_KERNEL);
0074     if (!pc)
0075         return -ENOMEM;
0076
0077     platform_set_drvdata(pdev, pc);
0078
0079     pc->dev = dev;
0080     pc->driver_data = driver_data;
0081
0082     pc->regs = syscon_node_to_regmap(dev->parent->of_node);
0083     if (IS_ERR(pc->regs))
0084         return PTR_ERR(pc->regs);
0085
0086     pc->pctl_desc.name = dev_name(dev);
0087     pc->pctl_desc.pins = soc->pins;
0088     pc->pctl_desc.npins = soc->npins;
0089     pc->pctl_desc.pctlops = soc->pctl_ops;
0090     pc->pctl_desc.pmxops = soc->pmx_ops;
0091     pc->pctl_desc.owner = THIS_MODULE;
0092
0093     pc->pctl_dev = devm_pinctrl_register(dev, &pc->pctl_desc, pc);
0094     if (IS_ERR(pc->pctl_dev))
0095         return PTR_ERR(pc->pctl_dev);
0096
0097     for_each_child_of_node(dev->parent->of_node, node) {
0098         if (of_match_node(bcm63xx_gpio_of_match, node)) {
0099             err = bcm63xx_gpio_probe(dev, node, soc, pc);
0100             if (err) {
0101                 dev_err(dev, "could not add GPIO chip\n");
0102                 of_node_put(node);
0103                 return err;
0104             }
0105         }
0106     }
0107
0108     return 0;
0109 }