[deliverable/linux.git] / arch / arm / mach-w90x900 / gpio.c

/*
 * linux/arch/arm/mach-w90x900/gpio.c
 *
 * Generic nuc900 GPIO handling
 *
 *  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))
#define to_nuc900_gpio_chip(c) container_of(c, struct nuc900_gpio_chip, chip)

#define NUC900_GPIO_CHIP(name, base_gpio, nr_gpio)			\
	{								\
		.chip = {						\
			.label		  = name,			\
			.direction_input  = nuc900_dir_input,		\
			.direction_output = nuc900_dir_output,		\
			.get		  = nuc900_gpio_get,		\
			.set		  = nuc900_gpio_set,		\
			.base		  = base_gpio,			\
			.ngpio		  = nr_gpio,			\
		}							\
	}

struct nuc900_gpio_chip {
	struct gpio_chip	chip;
	void __iomem		*regbase;	/* Base of group register*/
	spinlock_t 		gpio_lock;
};

static int nuc900_gpio_get(struct gpio_chip *chip, unsigned offset)
{
	struct nuc900_gpio_chip *nuc900_gpio = to_nuc900_gpio_chip(chip);
	void __iomem *pio = nuc900_gpio->regbase + GPIO_IN;
	unsigned int regval;

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

	return (regval != 0);
}

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

	spin_lock_irqsave(&nuc900_gpio->gpio_lock, flags);

	regval = __raw_readl(pio);

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

	__raw_writel(regval, pio);

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

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

	spin_lock_irqsave(&nuc900_gpio->gpio_lock, flags);

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

	spin_unlock_irqrestore(&nuc900_gpio->gpio_lock, flags);

	return 0;
}

static int nuc900_dir_output(struct gpio_chip *chip, unsigned offset, int val)
{
	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;
	unsigned int regval;
	unsigned long flags;

	spin_lock_irqsave(&nuc900_gpio->gpio_lock, flags);

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

	spin_unlock_irqrestore(&nuc900_gpio->gpio_lock, flags);

	return 0;
}

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),
};

void __init nuc900_init_gpio(int nr_group)
{
	unsigned	i;
	struct nuc900_gpio_chip *gpio_chip;

	for (i = 0; i < nr_group; i++) {
		gpio_chip = &nuc900_gpio[i];
		spin_lock_init(&gpio_chip->gpio_lock);
		gpio_chip->regbase = GPIO_BASE + i * GROUPINERV;
		gpiochip_add(&gpio_chip->chip);
	}
}
Commit	Line	Data
c52d3d68	1	/*
35c9221a	2	* linux/arch/arm/mach-w90x900/gpio.c
c52d3d68	3	*
35c9221a	4	* Generic nuc900 GPIO handling
c52d3d68	5	*
	6	* Wan ZongShun <mcuos.com@gmail.com>
	7	*
	8	* This program is free software; you can redistribute it and/or modify
	9	* it under the terms of the GNU General Public License version 2 as
	10	* published by the Free Software Foundation.
	11	*/
	12
	13	#include <linux/clk.h>
	14	#include <linux/errno.h>
	15	#include <linux/interrupt.h>
	16	#include <linux/irq.h>
	17	#include <linux/debugfs.h>
	18	#include <linux/seq_file.h>
	19	#include <linux/kernel.h>
	20	#include <linux/list.h>
	21	#include <linux/module.h>
	22	#include <linux/io.h>
	23	#include <linux/gpio.h>
	24
	25	#include <mach/hardware.h>
	26
	27	#define GPIO_BASE (W90X900_VA_GPIO)
	28	#define GPIO_DIR (0x04)
	29	#define GPIO_OUT (0x08)
	30	#define GPIO_IN (0x0C)
	31	#define GROUPINERV (0x10)
	32	#define GPIO_GPIO(Nb) (0x00000001 << (Nb))
35c9221a	33	#define to_nuc900_gpio_chip(c) container_of(c, struct nuc900_gpio_chip, chip)
c52d3d68	34
35c9221a	35	#define NUC900_GPIO_CHIP(name, base_gpio, nr_gpio) \
c52d3d68	36	{ \
	37	.chip = { \
	38	.label = name, \
35c9221a	39	.direction_input = nuc900_dir_input, \
	40	.direction_output = nuc900_dir_output, \
	41	.get = nuc900_gpio_get, \
	42	.set = nuc900_gpio_set, \
c52d3d68	43	.base = base_gpio, \
	44	.ngpio = nr_gpio, \
	45	} \
	46	}
	47
35c9221a	48	struct nuc900_gpio_chip {
c52d3d68	49	struct gpio_chip chip;
	50	void __iomem regbase; / Base of group register*/
	51	spinlock_t gpio_lock;
	52	};
	53
35c9221a	54	static int nuc900_gpio_get(struct gpio_chip *chip, unsigned offset)
c52d3d68	55	{
35c9221a	56	struct nuc900_gpio_chip *nuc900_gpio = to_nuc900_gpio_chip(chip);
35c9221a	57	void __iomem *pio = nuc900_gpio->regbase + GPIO_IN;
c52d3d68	58	unsigned int regval;
	59
	60	regval = __raw_readl(pio);
	61	regval &= GPIO_GPIO(offset);
	62
	63	return (regval != 0);
	64	}
	65
35c9221a	66	static void nuc900_gpio_set(struct gpio_chip *chip, unsigned offset, int val)
c52d3d68	67	{
35c9221a	68	struct nuc900_gpio_chip *nuc900_gpio = to_nuc900_gpio_chip(chip);
35c9221a	69	void __iomem *pio = nuc900_gpio->regbase + GPIO_OUT;
c52d3d68	70	unsigned int regval;
	71	unsigned long flags;
	72
35c9221a	73	spin_lock_irqsave(&nuc900_gpio->gpio_lock, flags);
c52d3d68	74
	75	regval = __raw_readl(pio);
	76
	77	if (val)
	78	regval \|= GPIO_GPIO(offset);
	79	else
	80	regval &= ~GPIO_GPIO(offset);
	81
	82	__raw_writel(regval, pio);
	83
35c9221a	84	spin_unlock_irqrestore(&nuc900_gpio->gpio_lock, flags);
c52d3d68	85	}
c52d3d68	86
35c9221a	87	static int nuc900_dir_input(struct gpio_chip *chip, unsigned offset)
c52d3d68	88	{
35c9221a	89	struct nuc900_gpio_chip *nuc900_gpio = to_nuc900_gpio_chip(chip);
35c9221a	90	void __iomem *pio = nuc900_gpio->regbase + GPIO_DIR;
c52d3d68	91	unsigned int regval;
	92	unsigned long flags;
	93
35c9221a	94	spin_lock_irqsave(&nuc900_gpio->gpio_lock, flags);
c52d3d68	95
	96	regval = __raw_readl(pio);
	97	regval &= ~GPIO_GPIO(offset);
	98	__raw_writel(regval, pio);
	99
35c9221a	100	spin_unlock_irqrestore(&nuc900_gpio->gpio_lock, flags);
c52d3d68	101
	102	return 0;
	103	}
	104
35c9221a	105	static int nuc900_dir_output(struct gpio_chip *chip, unsigned offset, int val)
c52d3d68	106	{
35c9221a	107	struct nuc900_gpio_chip *nuc900_gpio = to_nuc900_gpio_chip(chip);
	108	void __iomem *outreg = nuc900_gpio->regbase + GPIO_OUT;
	109	void __iomem *pio = nuc900_gpio->regbase + GPIO_DIR;
c52d3d68	110	unsigned int regval;
	111	unsigned long flags;
	112
35c9221a	113	spin_lock_irqsave(&nuc900_gpio->gpio_lock, flags);
c52d3d68	114
	115	regval = __raw_readl(pio);
	116	regval \|= GPIO_GPIO(offset);
	117	__raw_writel(regval, pio);
	118
	119	regval = __raw_readl(outreg);
	120
	121	if (val)
	122	regval \|= GPIO_GPIO(offset);
	123	else
	124	regval &= ~GPIO_GPIO(offset);
	125
	126	__raw_writel(regval, outreg);
	127
35c9221a	128	spin_unlock_irqrestore(&nuc900_gpio->gpio_lock, flags);
c52d3d68	129
	130	return 0;
	131	}
	132
35c9221a	133	static struct nuc900_gpio_chip nuc900_gpio[] = {
	134	NUC900_GPIO_CHIP("GROUPC", 0, 16),
	135	NUC900_GPIO_CHIP("GROUPD", 16, 10),
	136	NUC900_GPIO_CHIP("GROUPE", 26, 14),
	137	NUC900_GPIO_CHIP("GROUPF", 40, 10),
	138	NUC900_GPIO_CHIP("GROUPG", 50, 17),
	139	NUC900_GPIO_CHIP("GROUPH", 67, 8),
	140	NUC900_GPIO_CHIP("GROUPI", 75, 17),
c52d3d68	141	};
c52d3d68	142
35c9221a	143	void __init nuc900_init_gpio(int nr_group)
c52d3d68	144	{
c52d3d68	145	unsigned i;
35c9221a	146	struct nuc900_gpio_chip *gpio_chip;
c52d3d68	147
c52d3d68	148	for (i = 0; i < nr_group; i++) {
35c9221a	149	gpio_chip = &nuc900_gpio[i];
c52d3d68	150	spin_lock_init(&gpio_chip->gpio_lock);
	151	gpio_chip->regbase = GPIO_BASE + i * GROUPINERV;
	152	gpiochip_add(&gpio_chip->chip);
	153	}
	154	}