gpio.c 3.8 KB
Newer Older
1
/*
2
 * linux/arch/arm/mach-w90x900/gpio.c
3
 *
4
 * Generic nuc900 GPIO handling
5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32
 *
 *  Wan ZongShun <mcuos.com@gmail.com>
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License version 2 as
 * published by the Free Software Foundation.
 */

#include <linux/clk.h>
#include <linux/errno.h>
#include <linux/interrupt.h>
#include <linux/irq.h>
#include <linux/debugfs.h>
#include <linux/seq_file.h>
#include <linux/kernel.h>
#include <linux/list.h>
#include <linux/module.h>
#include <linux/io.h>
#include <linux/gpio.h>

#include <mach/hardware.h>

#define GPIO_BASE 		(W90X900_VA_GPIO)
#define GPIO_DIR		(0x04)
#define GPIO_OUT		(0x08)
#define GPIO_IN			(0x0C)
#define GROUPINERV		(0x10)
#define GPIO_GPIO(Nb)		(0x00000001 << (Nb))
33
#define to_nuc900_gpio_chip(c) container_of(c, struct nuc900_gpio_chip, chip)
34

35
#define NUC900_GPIO_CHIP(name, base_gpio, nr_gpio)			\
36 37 38
	{								\
		.chip = {						\
			.label		  = name,			\
39 40 41 42
			.direction_input  = nuc900_dir_input,		\
			.direction_output = nuc900_dir_output,		\
			.get		  = nuc900_gpio_get,		\
			.set		  = nuc900_gpio_set,		\
43 44 45 46 47
			.base		  = base_gpio,			\
			.ngpio		  = nr_gpio,			\
		}							\
	}

48
struct nuc900_gpio_chip {
49 50 51 52 53
	struct gpio_chip	chip;
	void __iomem		*regbase;	/* Base of group register*/
	spinlock_t 		gpio_lock;
};

54
static int nuc900_gpio_get(struct gpio_chip *chip, unsigned offset)
55
{
56 57
	struct nuc900_gpio_chip *nuc900_gpio = to_nuc900_gpio_chip(chip);
	void __iomem *pio = nuc900_gpio->regbase + GPIO_IN;
58 59 60 61 62 63 64 65
	unsigned int regval;

	regval = __raw_readl(pio);
	regval &= GPIO_GPIO(offset);

	return (regval != 0);
}

66
static void nuc900_gpio_set(struct gpio_chip *chip, unsigned offset, int val)
67
{
68 69
	struct nuc900_gpio_chip *nuc900_gpio = to_nuc900_gpio_chip(chip);
	void __iomem *pio = nuc900_gpio->regbase + GPIO_OUT;
70 71 72
	unsigned int regval;
	unsigned long flags;

73
	spin_lock_irqsave(&nuc900_gpio->gpio_lock, flags);
74 75 76 77 78 79 80 81 82 83

	regval = __raw_readl(pio);

	if (val)
		regval |= GPIO_GPIO(offset);
	else
		regval &= ~GPIO_GPIO(offset);

	__raw_writel(regval, pio);

84
	spin_unlock_irqrestore(&nuc900_gpio->gpio_lock, flags);
85 86
}

87
static int nuc900_dir_input(struct gpio_chip *chip, unsigned offset)
88
{
89 90
	struct nuc900_gpio_chip *nuc900_gpio = to_nuc900_gpio_chip(chip);
	void __iomem *pio = nuc900_gpio->regbase + GPIO_DIR;
91 92 93
	unsigned int regval;
	unsigned long flags;

94
	spin_lock_irqsave(&nuc900_gpio->gpio_lock, flags);
95 96 97 98 99

	regval = __raw_readl(pio);
	regval &= ~GPIO_GPIO(offset);
	__raw_writel(regval, pio);

100
	spin_unlock_irqrestore(&nuc900_gpio->gpio_lock, flags);
101 102 103 104

	return 0;
}

105
static int nuc900_dir_output(struct gpio_chip *chip, unsigned offset, int val)
106
{
107 108 109
	struct nuc900_gpio_chip *nuc900_gpio = to_nuc900_gpio_chip(chip);
	void __iomem *outreg = nuc900_gpio->regbase + GPIO_OUT;
	void __iomem *pio = nuc900_gpio->regbase + GPIO_DIR;
110 111 112
	unsigned int regval;
	unsigned long flags;

113
	spin_lock_irqsave(&nuc900_gpio->gpio_lock, flags);
114 115 116 117 118 119 120 121 122 123 124 125 126 127

	regval = __raw_readl(pio);
	regval |= GPIO_GPIO(offset);
	__raw_writel(regval, pio);

	regval = __raw_readl(outreg);

	if (val)
		regval |= GPIO_GPIO(offset);
	else
		regval &= ~GPIO_GPIO(offset);

	__raw_writel(regval, outreg);

128
	spin_unlock_irqrestore(&nuc900_gpio->gpio_lock, flags);
129 130 131 132

	return 0;
}

133 134 135 136 137 138 139 140
static struct nuc900_gpio_chip nuc900_gpio[] = {
	NUC900_GPIO_CHIP("GROUPC", 0, 16),
	NUC900_GPIO_CHIP("GROUPD", 16, 10),
	NUC900_GPIO_CHIP("GROUPE", 26, 14),
	NUC900_GPIO_CHIP("GROUPF", 40, 10),
	NUC900_GPIO_CHIP("GROUPG", 50, 17),
	NUC900_GPIO_CHIP("GROUPH", 67, 8),
	NUC900_GPIO_CHIP("GROUPI", 75, 17),
141 142
};

143
void __init nuc900_init_gpio(int nr_group)
144 145
{
	unsigned	i;
146
	struct nuc900_gpio_chip *gpio_chip;
147 148

	for (i = 0; i < nr_group; i++) {
149
		gpio_chip = &nuc900_gpio[i];
150 151 152 153 154
		spin_lock_init(&gpio_chip->gpio_lock);
		gpio_chip->regbase = GPIO_BASE + i * GROUPINERV;
		gpiochip_add(&gpio_chip->chip);
	}
}