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 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 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 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