2
* A gpio chip driver for TXx9 SoCs
4
* Copyright (C) 2008 Atsushi Nemoto <anemo@mba.ocn.ne.jp>
6
* This program is free software; you can redistribute it and/or modify
7
* it under the terms of the GNU General Public License version 2 as
8
* published by the Free Software Foundation.
11
#include <linux/init.h>
12
#include <linux/spinlock.h>
13
#include <linux/gpio.h>
14
#include <linux/errno.h>
16
#include <asm/txx9pio.h>
18
static DEFINE_SPINLOCK(txx9_gpio_lock);
20
static struct txx9_pio_reg __iomem *txx9_pioptr;
22
static int txx9_gpio_get(struct gpio_chip *chip, unsigned int offset)
24
return __raw_readl(&txx9_pioptr->din) & (1 << offset);
27
static void txx9_gpio_set_raw(unsigned int offset, int value)
30
val = __raw_readl(&txx9_pioptr->dout);
34
val &= ~(1 << offset);
35
__raw_writel(val, &txx9_pioptr->dout);
38
static void txx9_gpio_set(struct gpio_chip *chip, unsigned int offset,
42
spin_lock_irqsave(&txx9_gpio_lock, flags);
43
txx9_gpio_set_raw(offset, value);
45
spin_unlock_irqrestore(&txx9_gpio_lock, flags);
48
static int txx9_gpio_dir_in(struct gpio_chip *chip, unsigned int offset)
51
spin_lock_irqsave(&txx9_gpio_lock, flags);
52
__raw_writel(__raw_readl(&txx9_pioptr->dir) & ~(1 << offset),
55
spin_unlock_irqrestore(&txx9_gpio_lock, flags);
59
static int txx9_gpio_dir_out(struct gpio_chip *chip, unsigned int offset,
63
spin_lock_irqsave(&txx9_gpio_lock, flags);
64
txx9_gpio_set_raw(offset, value);
65
__raw_writel(__raw_readl(&txx9_pioptr->dir) | (1 << offset),
68
spin_unlock_irqrestore(&txx9_gpio_lock, flags);
72
static struct gpio_chip txx9_gpio_chip = {
75
.direction_input = txx9_gpio_dir_in,
76
.direction_output = txx9_gpio_dir_out,
80
int __init txx9_gpio_init(unsigned long baseaddr,
81
unsigned int base, unsigned int num)
83
txx9_pioptr = ioremap(baseaddr, sizeof(struct txx9_pio_reg));
86
txx9_gpio_chip.base = base;
87
txx9_gpio_chip.ngpio = num;
88
return gpiochip_add(&txx9_gpio_chip);