cachepc-linux

Fork of AMDESE/linux with modifications for CachePC side-channel attack
git clone https://git.sinitax.com/sinitax/cachepc-linux
Log | Files | Refs | README | LICENSE | sfeed.txt

pinctrl-bcm63xx.c (2863B)

      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
     22static 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
     35static 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
     45static 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
     64int 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}