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-nsp-gpio.c (18663B)


      1/*
      2 * Copyright (C) 2014-2017 Broadcom
      3 *
      4 * This program is free software; you can redistribute it and/or
      5 * modify it under the terms of the GNU General Public License as
      6 * published by the Free Software Foundation version 2.
      7 *
      8 * This program is distributed "as is" WITHOUT ANY WARRANTY of any
      9 * kind, whether express or implied; without even the implied warranty
     10 * of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
     11 * GNU General Public License for more details.
     12 */
     13
     14/*
     15 * This file contains the Broadcom Northstar Plus (NSP) GPIO driver that
     16 * supports the chipCommonA GPIO controller. Basic PINCONF such as bias,
     17 * pull up/down, slew and drive strength are also supported in this driver.
     18 *
     19 * Pins from the chipCommonA  GPIO can be individually muxed to GPIO function,
     20 * through the interaction with the NSP IOMUX controller.
     21 */
     22
     23#include <linux/gpio/driver.h>
     24#include <linux/interrupt.h>
     25#include <linux/io.h>
     26#include <linux/ioport.h>
     27#include <linux/kernel.h>
     28#include <linux/of_address.h>
     29#include <linux/of_device.h>
     30#include <linux/of_irq.h>
     31#include <linux/pinctrl/pinconf.h>
     32#include <linux/pinctrl/pinconf-generic.h>
     33#include <linux/pinctrl/pinctrl.h>
     34#include <linux/slab.h>
     35
     36#include "../pinctrl-utils.h"
     37
     38#define NSP_CHIP_A_INT_STATUS		0x00
     39#define NSP_CHIP_A_INT_MASK		0x04
     40#define NSP_GPIO_DATA_IN		0x40
     41#define NSP_GPIO_DATA_OUT		0x44
     42#define NSP_GPIO_OUT_EN			0x48
     43#define NSP_GPIO_INT_POLARITY		0x50
     44#define NSP_GPIO_INT_MASK		0x54
     45#define NSP_GPIO_EVENT			0x58
     46#define NSP_GPIO_EVENT_INT_MASK		0x5c
     47#define NSP_GPIO_EVENT_INT_POLARITY	0x64
     48#define NSP_CHIP_A_GPIO_INT_BIT		0x01
     49
     50/* I/O parameters offset for chipcommon A GPIO */
     51#define NSP_GPIO_DRV_CTRL		0x00
     52#define NSP_GPIO_HYSTERESIS_EN		0x10
     53#define NSP_GPIO_SLEW_RATE_EN		0x14
     54#define NSP_PULL_UP_EN			0x18
     55#define NSP_PULL_DOWN_EN		0x1c
     56#define GPIO_DRV_STRENGTH_BITS		0x03
     57
     58/*
     59 * nsp GPIO core
     60 *
     61 * @dev: pointer to device
     62 * @base: I/O register base for nsp GPIO controller
     63 * @io_ctrl: I/O register base for PINCONF support outside the GPIO block
     64 * @gc: GPIO chip
     65 * @pctl: pointer to pinctrl_dev
     66 * @pctldesc: pinctrl descriptor
     67 * @lock: lock to protect access to I/O registers
     68 */
     69struct nsp_gpio {
     70	struct device *dev;
     71	void __iomem *base;
     72	void __iomem *io_ctrl;
     73	struct irq_chip irqchip;
     74	struct gpio_chip gc;
     75	struct pinctrl_dev *pctl;
     76	struct pinctrl_desc pctldesc;
     77	raw_spinlock_t lock;
     78};
     79
     80enum base_type {
     81	REG,
     82	IO_CTRL
     83};
     84
     85/*
     86 * Mapping from PINCONF pins to GPIO pins is 1-to-1
     87 */
     88static inline unsigned nsp_pin_to_gpio(unsigned pin)
     89{
     90	return pin;
     91}
     92
     93/*
     94 *  nsp_set_bit - set or clear one bit (corresponding to the GPIO pin) in a
     95 *  nsp GPIO register
     96 *
     97 *  @nsp_gpio: nsp GPIO device
     98 *  @base_type: reg base to modify
     99 *  @reg: register offset
    100 *  @gpio: GPIO pin
    101 *  @set: set or clear
    102 */
    103static inline void nsp_set_bit(struct nsp_gpio *chip, enum base_type address,
    104			       unsigned int reg, unsigned gpio, bool set)
    105{
    106	u32 val;
    107	void __iomem *base_address;
    108
    109	if (address == IO_CTRL)
    110		base_address = chip->io_ctrl;
    111	else
    112		base_address = chip->base;
    113
    114	val = readl(base_address + reg);
    115	if (set)
    116		val |= BIT(gpio);
    117	else
    118		val &= ~BIT(gpio);
    119
    120	writel(val, base_address + reg);
    121}
    122
    123/*
    124 *  nsp_get_bit - get one bit (corresponding to the GPIO pin) in a
    125 *  nsp GPIO register
    126 */
    127static inline bool nsp_get_bit(struct nsp_gpio *chip, enum base_type address,
    128			       unsigned int reg, unsigned gpio)
    129{
    130	if (address == IO_CTRL)
    131		return !!(readl(chip->io_ctrl + reg) & BIT(gpio));
    132	else
    133		return !!(readl(chip->base + reg) & BIT(gpio));
    134}
    135
    136static irqreturn_t nsp_gpio_irq_handler(int irq, void *data)
    137{
    138	struct gpio_chip *gc = (struct gpio_chip *)data;
    139	struct nsp_gpio *chip = gpiochip_get_data(gc);
    140	int bit;
    141	unsigned long int_bits = 0;
    142	u32 int_status;
    143
    144	/* go through the entire GPIOs and handle all interrupts */
    145	int_status = readl(chip->base + NSP_CHIP_A_INT_STATUS);
    146	if (int_status & NSP_CHIP_A_GPIO_INT_BIT) {
    147		unsigned int event, level;
    148
    149		/* Get level and edge interrupts */
    150		event = readl(chip->base + NSP_GPIO_EVENT_INT_MASK) &
    151			      readl(chip->base + NSP_GPIO_EVENT);
    152		level = readl(chip->base + NSP_GPIO_DATA_IN) ^
    153			      readl(chip->base + NSP_GPIO_INT_POLARITY);
    154		level &= readl(chip->base + NSP_GPIO_INT_MASK);
    155		int_bits = level | event;
    156
    157		for_each_set_bit(bit, &int_bits, gc->ngpio)
    158			generic_handle_domain_irq(gc->irq.domain, bit);
    159	}
    160
    161	return  int_bits ? IRQ_HANDLED : IRQ_NONE;
    162}
    163
    164static void nsp_gpio_irq_ack(struct irq_data *d)
    165{
    166	struct gpio_chip *gc = irq_data_get_irq_chip_data(d);
    167	struct nsp_gpio *chip = gpiochip_get_data(gc);
    168	unsigned gpio = d->hwirq;
    169	u32 val = BIT(gpio);
    170	u32 trigger_type;
    171
    172	trigger_type = irq_get_trigger_type(d->irq);
    173	if (trigger_type & (IRQ_TYPE_EDGE_FALLING | IRQ_TYPE_EDGE_RISING))
    174		writel(val, chip->base + NSP_GPIO_EVENT);
    175}
    176
    177/*
    178 *  nsp_gpio_irq_set_mask - mask/unmask a GPIO interrupt
    179 *
    180 *  @d: IRQ chip data
    181 *  @unmask: mask/unmask GPIO interrupt
    182 */
    183static void nsp_gpio_irq_set_mask(struct irq_data *d, bool unmask)
    184{
    185	struct gpio_chip *gc = irq_data_get_irq_chip_data(d);
    186	struct nsp_gpio *chip = gpiochip_get_data(gc);
    187	unsigned gpio = d->hwirq;
    188	u32 trigger_type;
    189
    190	trigger_type = irq_get_trigger_type(d->irq);
    191	if (trigger_type & (IRQ_TYPE_EDGE_FALLING | IRQ_TYPE_EDGE_RISING))
    192		nsp_set_bit(chip, REG, NSP_GPIO_EVENT_INT_MASK, gpio, unmask);
    193	else
    194		nsp_set_bit(chip, REG, NSP_GPIO_INT_MASK, gpio, unmask);
    195}
    196
    197static void nsp_gpio_irq_mask(struct irq_data *d)
    198{
    199	struct gpio_chip *gc = irq_data_get_irq_chip_data(d);
    200	struct nsp_gpio *chip = gpiochip_get_data(gc);
    201	unsigned long flags;
    202
    203	raw_spin_lock_irqsave(&chip->lock, flags);
    204	nsp_gpio_irq_set_mask(d, false);
    205	raw_spin_unlock_irqrestore(&chip->lock, flags);
    206}
    207
    208static void nsp_gpio_irq_unmask(struct irq_data *d)
    209{
    210	struct gpio_chip *gc = irq_data_get_irq_chip_data(d);
    211	struct nsp_gpio *chip = gpiochip_get_data(gc);
    212	unsigned long flags;
    213
    214	raw_spin_lock_irqsave(&chip->lock, flags);
    215	nsp_gpio_irq_set_mask(d, true);
    216	raw_spin_unlock_irqrestore(&chip->lock, flags);
    217}
    218
    219static int nsp_gpio_irq_set_type(struct irq_data *d, unsigned int type)
    220{
    221	struct gpio_chip *gc = irq_data_get_irq_chip_data(d);
    222	struct nsp_gpio *chip = gpiochip_get_data(gc);
    223	unsigned gpio = d->hwirq;
    224	bool level_low;
    225	bool falling;
    226	unsigned long flags;
    227
    228	raw_spin_lock_irqsave(&chip->lock, flags);
    229	falling = nsp_get_bit(chip, REG, NSP_GPIO_EVENT_INT_POLARITY, gpio);
    230	level_low = nsp_get_bit(chip, REG, NSP_GPIO_INT_POLARITY, gpio);
    231
    232	switch (type & IRQ_TYPE_SENSE_MASK) {
    233	case IRQ_TYPE_EDGE_RISING:
    234		falling = false;
    235		break;
    236
    237	case IRQ_TYPE_EDGE_FALLING:
    238		falling = true;
    239		break;
    240
    241	case IRQ_TYPE_LEVEL_HIGH:
    242		level_low = false;
    243		break;
    244
    245	case IRQ_TYPE_LEVEL_LOW:
    246		level_low = true;
    247		break;
    248
    249	default:
    250		dev_err(chip->dev, "invalid GPIO IRQ type 0x%x\n",
    251			type);
    252		raw_spin_unlock_irqrestore(&chip->lock, flags);
    253		return -EINVAL;
    254	}
    255
    256	nsp_set_bit(chip, REG, NSP_GPIO_EVENT_INT_POLARITY, gpio, falling);
    257	nsp_set_bit(chip, REG, NSP_GPIO_INT_POLARITY, gpio, level_low);
    258
    259	if (type & IRQ_TYPE_EDGE_BOTH)
    260		irq_set_handler_locked(d, handle_edge_irq);
    261	else
    262		irq_set_handler_locked(d, handle_level_irq);
    263
    264	raw_spin_unlock_irqrestore(&chip->lock, flags);
    265
    266	dev_dbg(chip->dev, "gpio:%u level_low:%s falling:%s\n", gpio,
    267		level_low ? "true" : "false", falling ? "true" : "false");
    268	return 0;
    269}
    270
    271static int nsp_gpio_direction_input(struct gpio_chip *gc, unsigned gpio)
    272{
    273	struct nsp_gpio *chip = gpiochip_get_data(gc);
    274	unsigned long flags;
    275
    276	raw_spin_lock_irqsave(&chip->lock, flags);
    277	nsp_set_bit(chip, REG, NSP_GPIO_OUT_EN, gpio, false);
    278	raw_spin_unlock_irqrestore(&chip->lock, flags);
    279
    280	dev_dbg(chip->dev, "gpio:%u set input\n", gpio);
    281	return 0;
    282}
    283
    284static int nsp_gpio_direction_output(struct gpio_chip *gc, unsigned gpio,
    285				     int val)
    286{
    287	struct nsp_gpio *chip = gpiochip_get_data(gc);
    288	unsigned long flags;
    289
    290	raw_spin_lock_irqsave(&chip->lock, flags);
    291	nsp_set_bit(chip, REG, NSP_GPIO_OUT_EN, gpio, true);
    292	nsp_set_bit(chip, REG, NSP_GPIO_DATA_OUT, gpio, !!(val));
    293	raw_spin_unlock_irqrestore(&chip->lock, flags);
    294
    295	dev_dbg(chip->dev, "gpio:%u set output, value:%d\n", gpio, val);
    296	return 0;
    297}
    298
    299static int nsp_gpio_get_direction(struct gpio_chip *gc, unsigned gpio)
    300{
    301	struct nsp_gpio *chip = gpiochip_get_data(gc);
    302	unsigned long flags;
    303	int val;
    304
    305	raw_spin_lock_irqsave(&chip->lock, flags);
    306	val = nsp_get_bit(chip, REG, NSP_GPIO_OUT_EN, gpio);
    307	raw_spin_unlock_irqrestore(&chip->lock, flags);
    308
    309	return !val;
    310}
    311
    312static void nsp_gpio_set(struct gpio_chip *gc, unsigned gpio, int val)
    313{
    314	struct nsp_gpio *chip = gpiochip_get_data(gc);
    315	unsigned long flags;
    316
    317	raw_spin_lock_irqsave(&chip->lock, flags);
    318	nsp_set_bit(chip, REG, NSP_GPIO_DATA_OUT, gpio, !!(val));
    319	raw_spin_unlock_irqrestore(&chip->lock, flags);
    320
    321	dev_dbg(chip->dev, "gpio:%u set, value:%d\n", gpio, val);
    322}
    323
    324static int nsp_gpio_get(struct gpio_chip *gc, unsigned gpio)
    325{
    326	struct nsp_gpio *chip = gpiochip_get_data(gc);
    327
    328	return !!(readl(chip->base + NSP_GPIO_DATA_IN) & BIT(gpio));
    329}
    330
    331static int nsp_get_groups_count(struct pinctrl_dev *pctldev)
    332{
    333	return 1;
    334}
    335
    336/*
    337 * Only one group: "gpio_grp", since this local pinctrl device only performs
    338 * GPIO specific PINCONF configurations
    339 */
    340static const char *nsp_get_group_name(struct pinctrl_dev *pctldev,
    341				      unsigned selector)
    342{
    343	return "gpio_grp";
    344}
    345
    346static const struct pinctrl_ops nsp_pctrl_ops = {
    347	.get_groups_count = nsp_get_groups_count,
    348	.get_group_name = nsp_get_group_name,
    349	.dt_node_to_map = pinconf_generic_dt_node_to_map_pin,
    350	.dt_free_map = pinctrl_utils_free_map,
    351};
    352
    353static int nsp_gpio_set_slew(struct nsp_gpio *chip, unsigned gpio, u32 slew)
    354{
    355	if (slew)
    356		nsp_set_bit(chip, IO_CTRL, NSP_GPIO_SLEW_RATE_EN, gpio, true);
    357	else
    358		nsp_set_bit(chip, IO_CTRL, NSP_GPIO_SLEW_RATE_EN, gpio, false);
    359
    360	return 0;
    361}
    362
    363static int nsp_gpio_set_pull(struct nsp_gpio *chip, unsigned gpio,
    364			     bool pull_up, bool pull_down)
    365{
    366	unsigned long flags;
    367
    368	raw_spin_lock_irqsave(&chip->lock, flags);
    369	nsp_set_bit(chip, IO_CTRL, NSP_PULL_DOWN_EN, gpio, pull_down);
    370	nsp_set_bit(chip, IO_CTRL, NSP_PULL_UP_EN, gpio, pull_up);
    371	raw_spin_unlock_irqrestore(&chip->lock, flags);
    372
    373	dev_dbg(chip->dev, "gpio:%u set pullup:%d pulldown: %d\n",
    374		gpio, pull_up, pull_down);
    375	return 0;
    376}
    377
    378static void nsp_gpio_get_pull(struct nsp_gpio *chip, unsigned gpio,
    379			      bool *pull_up, bool *pull_down)
    380{
    381	unsigned long flags;
    382
    383	raw_spin_lock_irqsave(&chip->lock, flags);
    384	*pull_up = nsp_get_bit(chip, IO_CTRL, NSP_PULL_UP_EN, gpio);
    385	*pull_down = nsp_get_bit(chip, IO_CTRL, NSP_PULL_DOWN_EN, gpio);
    386	raw_spin_unlock_irqrestore(&chip->lock, flags);
    387}
    388
    389static int nsp_gpio_set_strength(struct nsp_gpio *chip, unsigned gpio,
    390				 u32 strength)
    391{
    392	u32 offset, shift, i;
    393	u32 val;
    394	unsigned long flags;
    395
    396	/* make sure drive strength is supported */
    397	if (strength < 2 || strength > 16 || (strength % 2))
    398		return -ENOTSUPP;
    399
    400	shift = gpio;
    401	offset = NSP_GPIO_DRV_CTRL;
    402	dev_dbg(chip->dev, "gpio:%u set drive strength:%d mA\n", gpio,
    403		strength);
    404	raw_spin_lock_irqsave(&chip->lock, flags);
    405	strength = (strength / 2) - 1;
    406	for (i = GPIO_DRV_STRENGTH_BITS; i > 0; i--) {
    407		val = readl(chip->io_ctrl + offset);
    408		val &= ~BIT(shift);
    409		val |= ((strength >> (i-1)) & 0x1) << shift;
    410		writel(val, chip->io_ctrl + offset);
    411		offset += 4;
    412	}
    413	raw_spin_unlock_irqrestore(&chip->lock, flags);
    414
    415	return 0;
    416}
    417
    418static int nsp_gpio_get_strength(struct nsp_gpio *chip, unsigned gpio,
    419				 u16 *strength)
    420{
    421	unsigned int offset, shift;
    422	u32 val;
    423	unsigned long flags;
    424	int i;
    425
    426	offset = NSP_GPIO_DRV_CTRL;
    427	shift = gpio;
    428
    429	raw_spin_lock_irqsave(&chip->lock, flags);
    430	*strength = 0;
    431	for (i = (GPIO_DRV_STRENGTH_BITS - 1); i >= 0; i--) {
    432		val = readl(chip->io_ctrl + offset) & BIT(shift);
    433		val >>= shift;
    434		*strength += (val << i);
    435		offset += 4;
    436	}
    437
    438	/* convert to mA */
    439	*strength = (*strength + 1) * 2;
    440	raw_spin_unlock_irqrestore(&chip->lock, flags);
    441
    442	return 0;
    443}
    444
    445static int nsp_pin_config_group_get(struct pinctrl_dev *pctldev,
    446				    unsigned selector,
    447			     unsigned long *config)
    448{
    449	return 0;
    450}
    451
    452static int nsp_pin_config_group_set(struct pinctrl_dev *pctldev,
    453				    unsigned selector,
    454			     unsigned long *configs, unsigned num_configs)
    455{
    456	return 0;
    457}
    458
    459static int nsp_pin_config_get(struct pinctrl_dev *pctldev, unsigned pin,
    460			      unsigned long *config)
    461{
    462	struct nsp_gpio *chip = pinctrl_dev_get_drvdata(pctldev);
    463	enum pin_config_param param = pinconf_to_config_param(*config);
    464	unsigned int gpio;
    465	u16 arg = 0;
    466	bool pull_up, pull_down;
    467	int ret;
    468
    469	gpio = nsp_pin_to_gpio(pin);
    470	switch (param) {
    471	case PIN_CONFIG_BIAS_DISABLE:
    472		nsp_gpio_get_pull(chip, gpio, &pull_up, &pull_down);
    473		if ((pull_up == false) && (pull_down == false))
    474			return 0;
    475		else
    476			return -EINVAL;
    477
    478	case PIN_CONFIG_BIAS_PULL_UP:
    479		nsp_gpio_get_pull(chip, gpio, &pull_up, &pull_down);
    480		if (pull_up)
    481			return 0;
    482		else
    483			return -EINVAL;
    484
    485	case PIN_CONFIG_BIAS_PULL_DOWN:
    486		nsp_gpio_get_pull(chip, gpio, &pull_up, &pull_down);
    487		if (pull_down)
    488			return 0;
    489		else
    490			return -EINVAL;
    491
    492	case PIN_CONFIG_DRIVE_STRENGTH:
    493		ret = nsp_gpio_get_strength(chip, gpio, &arg);
    494		if (ret)
    495			return ret;
    496		*config = pinconf_to_config_packed(param, arg);
    497		return 0;
    498
    499	default:
    500		return -ENOTSUPP;
    501	}
    502}
    503
    504static int nsp_pin_config_set(struct pinctrl_dev *pctldev, unsigned pin,
    505			      unsigned long *configs, unsigned num_configs)
    506{
    507	struct nsp_gpio *chip = pinctrl_dev_get_drvdata(pctldev);
    508	enum pin_config_param param;
    509	u32 arg;
    510	unsigned int i, gpio;
    511	int ret = -ENOTSUPP;
    512
    513	gpio = nsp_pin_to_gpio(pin);
    514	for (i = 0; i < num_configs; i++) {
    515		param = pinconf_to_config_param(configs[i]);
    516		arg = pinconf_to_config_argument(configs[i]);
    517
    518		switch (param) {
    519		case PIN_CONFIG_BIAS_DISABLE:
    520			ret = nsp_gpio_set_pull(chip, gpio, false, false);
    521			if (ret < 0)
    522				goto out;
    523			break;
    524
    525		case PIN_CONFIG_BIAS_PULL_UP:
    526			ret = nsp_gpio_set_pull(chip, gpio, true, false);
    527			if (ret < 0)
    528				goto out;
    529			break;
    530
    531		case PIN_CONFIG_BIAS_PULL_DOWN:
    532			ret = nsp_gpio_set_pull(chip, gpio, false, true);
    533			if (ret < 0)
    534				goto out;
    535			break;
    536
    537		case PIN_CONFIG_DRIVE_STRENGTH:
    538			ret = nsp_gpio_set_strength(chip, gpio, arg);
    539			if (ret < 0)
    540				goto out;
    541			break;
    542
    543		case PIN_CONFIG_SLEW_RATE:
    544			ret = nsp_gpio_set_slew(chip, gpio, arg);
    545			if (ret < 0)
    546				goto out;
    547			break;
    548
    549		default:
    550			dev_err(chip->dev, "invalid configuration\n");
    551			return -ENOTSUPP;
    552		}
    553	}
    554
    555out:
    556	return ret;
    557}
    558
    559static const struct pinconf_ops nsp_pconf_ops = {
    560	.is_generic = true,
    561	.pin_config_get = nsp_pin_config_get,
    562	.pin_config_set = nsp_pin_config_set,
    563	.pin_config_group_get = nsp_pin_config_group_get,
    564	.pin_config_group_set = nsp_pin_config_group_set,
    565};
    566
    567/*
    568 * NSP GPIO controller supports some PINCONF related configurations such as
    569 * pull up, pull down, slew and drive strength, when the pin is configured
    570 * to GPIO.
    571 *
    572 * Here a local pinctrl device is created with simple 1-to-1 pin mapping to the
    573 * local GPIO pins
    574 */
    575static int nsp_gpio_register_pinconf(struct nsp_gpio *chip)
    576{
    577	struct pinctrl_desc *pctldesc = &chip->pctldesc;
    578	struct pinctrl_pin_desc *pins;
    579	struct gpio_chip *gc = &chip->gc;
    580	int i;
    581
    582	pins = devm_kcalloc(chip->dev, gc->ngpio, sizeof(*pins), GFP_KERNEL);
    583	if (!pins)
    584		return -ENOMEM;
    585	for (i = 0; i < gc->ngpio; i++) {
    586		pins[i].number = i;
    587		pins[i].name = devm_kasprintf(chip->dev, GFP_KERNEL,
    588					      "gpio-%d", i);
    589		if (!pins[i].name)
    590			return -ENOMEM;
    591	}
    592	pctldesc->name = dev_name(chip->dev);
    593	pctldesc->pctlops = &nsp_pctrl_ops;
    594	pctldesc->pins = pins;
    595	pctldesc->npins = gc->ngpio;
    596	pctldesc->confops = &nsp_pconf_ops;
    597
    598	chip->pctl = devm_pinctrl_register(chip->dev, pctldesc, chip);
    599	if (IS_ERR(chip->pctl)) {
    600		dev_err(chip->dev, "unable to register pinctrl device\n");
    601		return PTR_ERR(chip->pctl);
    602	}
    603
    604	return 0;
    605}
    606
    607static const struct of_device_id nsp_gpio_of_match[] = {
    608	{.compatible = "brcm,nsp-gpio-a",},
    609	{}
    610};
    611
    612static int nsp_gpio_probe(struct platform_device *pdev)
    613{
    614	struct device *dev = &pdev->dev;
    615	struct nsp_gpio *chip;
    616	struct gpio_chip *gc;
    617	u32 val;
    618	int irq, ret;
    619
    620	if (of_property_read_u32(pdev->dev.of_node, "ngpios", &val)) {
    621		dev_err(&pdev->dev, "Missing ngpios OF property\n");
    622		return -ENODEV;
    623	}
    624
    625	chip = devm_kzalloc(dev, sizeof(*chip), GFP_KERNEL);
    626	if (!chip)
    627		return -ENOMEM;
    628
    629	chip->dev = dev;
    630	platform_set_drvdata(pdev, chip);
    631
    632	chip->base = devm_platform_ioremap_resource(pdev, 0);
    633	if (IS_ERR(chip->base)) {
    634		dev_err(dev, "unable to map I/O memory\n");
    635		return PTR_ERR(chip->base);
    636	}
    637
    638	chip->io_ctrl = devm_platform_ioremap_resource(pdev, 1);
    639	if (IS_ERR(chip->io_ctrl)) {
    640		dev_err(dev, "unable to map I/O memory\n");
    641		return PTR_ERR(chip->io_ctrl);
    642	}
    643
    644	raw_spin_lock_init(&chip->lock);
    645	gc = &chip->gc;
    646	gc->base = -1;
    647	gc->can_sleep = false;
    648	gc->ngpio = val;
    649	gc->label = dev_name(dev);
    650	gc->parent = dev;
    651	gc->request = gpiochip_generic_request;
    652	gc->free = gpiochip_generic_free;
    653	gc->direction_input = nsp_gpio_direction_input;
    654	gc->direction_output = nsp_gpio_direction_output;
    655	gc->get_direction = nsp_gpio_get_direction;
    656	gc->set = nsp_gpio_set;
    657	gc->get = nsp_gpio_get;
    658
    659	/* optional GPIO interrupt support */
    660	irq = platform_get_irq(pdev, 0);
    661	if (irq > 0) {
    662		struct gpio_irq_chip *girq;
    663		struct irq_chip *irqc;
    664
    665		irqc = &chip->irqchip;
    666		irqc->name = "gpio-a";
    667		irqc->irq_ack = nsp_gpio_irq_ack;
    668		irqc->irq_mask = nsp_gpio_irq_mask;
    669		irqc->irq_unmask = nsp_gpio_irq_unmask;
    670		irqc->irq_set_type = nsp_gpio_irq_set_type;
    671
    672		val = readl(chip->base + NSP_CHIP_A_INT_MASK);
    673		val = val | NSP_CHIP_A_GPIO_INT_BIT;
    674		writel(val, (chip->base + NSP_CHIP_A_INT_MASK));
    675
    676		/* Install ISR for this GPIO controller. */
    677		ret = devm_request_irq(dev, irq, nsp_gpio_irq_handler,
    678				       IRQF_SHARED, "gpio-a", &chip->gc);
    679		if (ret) {
    680			dev_err(&pdev->dev, "Unable to request IRQ%d: %d\n",
    681				irq, ret);
    682			return ret;
    683		}
    684
    685		girq = &chip->gc.irq;
    686		girq->chip = irqc;
    687		/* This will let us handle the parent IRQ in the driver */
    688		girq->parent_handler = NULL;
    689		girq->num_parents = 0;
    690		girq->parents = NULL;
    691		girq->default_type = IRQ_TYPE_NONE;
    692		girq->handler = handle_bad_irq;
    693	}
    694
    695	ret = devm_gpiochip_add_data(dev, gc, chip);
    696	if (ret < 0) {
    697		dev_err(dev, "unable to add GPIO chip\n");
    698		return ret;
    699	}
    700
    701	ret = nsp_gpio_register_pinconf(chip);
    702	if (ret) {
    703		dev_err(dev, "unable to register pinconf\n");
    704		return ret;
    705	}
    706
    707	return 0;
    708}
    709
    710static struct platform_driver nsp_gpio_driver = {
    711	.driver = {
    712		.name = "nsp-gpio-a",
    713		.of_match_table = nsp_gpio_of_match,
    714	},
    715	.probe = nsp_gpio_probe,
    716};
    717
    718static int __init nsp_gpio_init(void)
    719{
    720	return platform_driver_register(&nsp_gpio_driver);
    721}
    722arch_initcall_sync(nsp_gpio_init);