projects / linux-block.git / blame
| Commit | Line | Data |
|---|---|---|
| 132f9501 ÁFR |
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; | |
| 132f9501 ÁFR |
70 | int err; |
| 71 | ||
| 72 | pc = devm_kzalloc(dev, sizeof(*pc), GFP_KERNEL); | |
| 73 | if (!pc) | |
| 74 | return -ENOMEM; | |
| 75 | ||
| 76 | platform_set_drvdata(pdev, pc); | |
| 77 | ||
| 78 | pc->dev = dev; | |
| 79 | pc->driver_data = driver_data; | |
| 80 | ||
| 81 | pc->regs = syscon_node_to_regmap(dev->parent->of_node); | |
| 82 | if (IS_ERR(pc->regs)) | |
| 83 | return PTR_ERR(pc->regs); | |
| 84 | ||
| 85 | pc->pctl_desc.name = dev_name(dev); | |
| 86 | pc->pctl_desc.pins = soc->pins; | |
| 87 | pc->pctl_desc.npins = soc->npins; | |
| 88 | pc->pctl_desc.pctlops = soc->pctl_ops; | |
| 89 | pc->pctl_desc.pmxops = soc->pmx_ops; | |
| 90 | pc->pctl_desc.owner = THIS_MODULE; | |
| 91 | ||
| 92 | pc->pctl_dev = devm_pinctrl_register(dev, &pc->pctl_desc, pc); | |
| 93 | if (IS_ERR(pc->pctl_dev)) | |
| 94 | return PTR_ERR(pc->pctl_dev); | |
| 95 | ||
| 240c5f23 | 96 | for_each_child_of_node_scoped(dev->parent->of_node, node) { |
| 132f9501 ÁFR |
97 | if (of_match_node(bcm63xx_gpio_of_match, node)) { |
| 98 | err = bcm63xx_gpio_probe(dev, node, soc, pc); | |
| 99 | if (err) { | |
| 100 | dev_err(dev, "could not add GPIO chip\n"); | |
| 132f9501 ÁFR |
101 | return err; |
| 102 | } | |
| 103 | } | |
| 104 | } | |
| 105 | ||
| 106 | return 0; | |
| 107 | } |