1 // SPDX-License-Identifier: GPL-2.0+
2 /*
3  * Driver for BCM63xx GPIO unit (pinctrl + GPIO)
4  *
5  * Copyright (C) 2021 Álvaro Fernández Rojas <noltari@gmail.com>
6  * Copyright (C) 2016 Jonas Gorski <jonas.gorski@gmail.com>
7  */
8 
9 #include <linux/gpio/regmap.h>
10 #include <linux/mfd/syscon.h>
11 #include <linux/mod_devicetable.h>
12 #include <linux/of.h>
13 #include <linux/platform_device.h>
14 
15 #include "pinctrl-bcm63xx.h"
16 
17 #define BCM63XX_BANK_SIZE	4
18 
19 #define BCM63XX_DIROUT_REG	0x04
20 #define BCM63XX_DATA_REG	0x0c
21 
bcm63xx_reg_mask_xlate(struct gpio_regmap * gpio,unsigned int base,unsigned int offset,unsigned int * reg,unsigned int * mask)22 static int bcm63xx_reg_mask_xlate(struct gpio_regmap *gpio,
23 				  unsigned int base, unsigned int offset,
24 				  unsigned int *reg, unsigned int *mask)
25 {
26 	unsigned int line = offset % BCM63XX_BANK_GPIOS;
27 	unsigned int stride = offset / BCM63XX_BANK_GPIOS;
28 
29 	*reg = base - stride * BCM63XX_BANK_SIZE;
30 	*mask = BIT(line);
31 
32 	return 0;
33 }
34 
35 static const struct of_device_id bcm63xx_gpio_of_match[] = {
36 	{ .compatible = "brcm,bcm6318-gpio", },
37 	{ .compatible = "brcm,bcm6328-gpio", },
38 	{ .compatible = "brcm,bcm6358-gpio", },
39 	{ .compatible = "brcm,bcm6362-gpio", },
40 	{ .compatible = "brcm,bcm6368-gpio", },
41 	{ .compatible = "brcm,bcm63268-gpio", },
42 	{ /* sentinel */ }
43 };
44 
bcm63xx_gpio_probe(struct device * dev,struct device_node * node,const struct bcm63xx_pinctrl_soc * soc,struct bcm63xx_pinctrl * pc)45 static int bcm63xx_gpio_probe(struct device *dev, struct device_node *node,
46 			      const struct bcm63xx_pinctrl_soc *soc,
47 			      struct bcm63xx_pinctrl *pc)
48 {
49 	struct gpio_regmap_config grc = {0};
50 
51 	grc.parent = dev;
52 	grc.fwnode = &node->fwnode;
53 	grc.ngpio = soc->ngpios;
54 	grc.ngpio_per_reg = BCM63XX_BANK_GPIOS;
55 	grc.regmap = pc->regs;
56 	grc.reg_dat_base = BCM63XX_DATA_REG;
57 	grc.reg_dir_out_base = BCM63XX_DIROUT_REG;
58 	grc.reg_set_base = BCM63XX_DATA_REG;
59 	grc.reg_mask_xlate = bcm63xx_reg_mask_xlate;
60 
61 	return PTR_ERR_OR_ZERO(devm_gpio_regmap_register(dev, &grc));
62 }
63 
bcm63xx_pinctrl_probe(struct platform_device * pdev,const struct bcm63xx_pinctrl_soc * soc,void * driver_data)64 int bcm63xx_pinctrl_probe(struct platform_device *pdev,
65 			  const struct bcm63xx_pinctrl_soc *soc,
66 			  void *driver_data)
67 {
68 	struct device *dev = &pdev->dev;
69 	struct bcm63xx_pinctrl *pc;
70 	struct device_node *node;
71 	int err;
72 
73 	pc = devm_kzalloc(dev, sizeof(*pc), GFP_KERNEL);
74 	if (!pc)
75 		return -ENOMEM;
76 
77 	platform_set_drvdata(pdev, pc);
78 
79 	pc->dev = dev;
80 	pc->driver_data = driver_data;
81 
82 	pc->regs = syscon_node_to_regmap(dev->parent->of_node);
83 	if (IS_ERR(pc->regs))
84 		return PTR_ERR(pc->regs);
85 
86 	pc->pctl_desc.name = dev_name(dev);
87 	pc->pctl_desc.pins = soc->pins;
88 	pc->pctl_desc.npins = soc->npins;
89 	pc->pctl_desc.pctlops = soc->pctl_ops;
90 	pc->pctl_desc.pmxops = soc->pmx_ops;
91 	pc->pctl_desc.owner = THIS_MODULE;
92 
93 	pc->pctl_dev = devm_pinctrl_register(dev, &pc->pctl_desc, pc);
94 	if (IS_ERR(pc->pctl_dev))
95 		return PTR_ERR(pc->pctl_dev);
96 
97 	for_each_child_of_node(dev->parent->of_node, node) {
98 		if (of_match_node(bcm63xx_gpio_of_match, node)) {
99 			err = bcm63xx_gpio_probe(dev, node, soc, pc);
100 			if (err) {
101 				dev_err(dev, "could not add GPIO chip\n");
102 				of_node_put(node);
103 				return err;
104 			}
105 		}
106 	}
107 
108 	return 0;
109 }
110