1a9aec7feSAtsushi Nemoto /* 2a9aec7feSAtsushi Nemoto * A gpio chip driver for TXx9 SoCs 3a9aec7feSAtsushi Nemoto * 4a9aec7feSAtsushi Nemoto * Copyright (C) 2008 Atsushi Nemoto <anemo@mba.ocn.ne.jp> 5a9aec7feSAtsushi Nemoto * 6a9aec7feSAtsushi Nemoto * This program is free software; you can redistribute it and/or modify 7a9aec7feSAtsushi Nemoto * it under the terms of the GNU General Public License version 2 as 8a9aec7feSAtsushi Nemoto * published by the Free Software Foundation. 9a9aec7feSAtsushi Nemoto */ 10a9aec7feSAtsushi Nemoto 11a9aec7feSAtsushi Nemoto #include <linux/init.h> 12a9aec7feSAtsushi Nemoto #include <linux/spinlock.h> 13a9aec7feSAtsushi Nemoto #include <linux/gpio.h> 14a9aec7feSAtsushi Nemoto #include <linux/errno.h> 15a9aec7feSAtsushi Nemoto #include <linux/io.h> 16a9aec7feSAtsushi Nemoto #include <asm/txx9pio.h> 17a9aec7feSAtsushi Nemoto 18a9aec7feSAtsushi Nemoto static DEFINE_SPINLOCK(txx9_gpio_lock); 19a9aec7feSAtsushi Nemoto 20a9aec7feSAtsushi Nemoto static struct txx9_pio_reg __iomem *txx9_pioptr; 21a9aec7feSAtsushi Nemoto 22a9aec7feSAtsushi Nemoto static int txx9_gpio_get(struct gpio_chip *chip, unsigned int offset) 23a9aec7feSAtsushi Nemoto { 24a9aec7feSAtsushi Nemoto return __raw_readl(&txx9_pioptr->din) & (1 << offset); 25a9aec7feSAtsushi Nemoto } 26a9aec7feSAtsushi Nemoto 27a9aec7feSAtsushi Nemoto static void txx9_gpio_set_raw(unsigned int offset, int value) 28a9aec7feSAtsushi Nemoto { 29a9aec7feSAtsushi Nemoto u32 val; 30a9aec7feSAtsushi Nemoto val = __raw_readl(&txx9_pioptr->dout); 31a9aec7feSAtsushi Nemoto if (value) 32a9aec7feSAtsushi Nemoto val |= 1 << offset; 33a9aec7feSAtsushi Nemoto else 34a9aec7feSAtsushi Nemoto val &= ~(1 << offset); 35a9aec7feSAtsushi Nemoto __raw_writel(val, &txx9_pioptr->dout); 36a9aec7feSAtsushi Nemoto } 37a9aec7feSAtsushi Nemoto 38a9aec7feSAtsushi Nemoto static void txx9_gpio_set(struct gpio_chip *chip, unsigned int offset, 39a9aec7feSAtsushi Nemoto int value) 40a9aec7feSAtsushi Nemoto { 41a9aec7feSAtsushi Nemoto unsigned long flags; 42a9aec7feSAtsushi Nemoto spin_lock_irqsave(&txx9_gpio_lock, flags); 43a9aec7feSAtsushi Nemoto txx9_gpio_set_raw(offset, value); 44a9aec7feSAtsushi Nemoto mmiowb(); 45a9aec7feSAtsushi Nemoto spin_unlock_irqrestore(&txx9_gpio_lock, flags); 46a9aec7feSAtsushi Nemoto } 47a9aec7feSAtsushi Nemoto 48a9aec7feSAtsushi Nemoto static int txx9_gpio_dir_in(struct gpio_chip *chip, unsigned int offset) 49a9aec7feSAtsushi Nemoto { 50a9aec7feSAtsushi Nemoto spin_lock_irq(&txx9_gpio_lock); 51a9aec7feSAtsushi Nemoto __raw_writel(__raw_readl(&txx9_pioptr->dir) & ~(1 << offset), 52a9aec7feSAtsushi Nemoto &txx9_pioptr->dir); 53a9aec7feSAtsushi Nemoto mmiowb(); 54a9aec7feSAtsushi Nemoto spin_unlock_irq(&txx9_gpio_lock); 55a9aec7feSAtsushi Nemoto return 0; 56a9aec7feSAtsushi Nemoto } 57a9aec7feSAtsushi Nemoto 58a9aec7feSAtsushi Nemoto static int txx9_gpio_dir_out(struct gpio_chip *chip, unsigned int offset, 59a9aec7feSAtsushi Nemoto int value) 60a9aec7feSAtsushi Nemoto { 61a9aec7feSAtsushi Nemoto spin_lock_irq(&txx9_gpio_lock); 62a9aec7feSAtsushi Nemoto txx9_gpio_set_raw(offset, value); 63a9aec7feSAtsushi Nemoto __raw_writel(__raw_readl(&txx9_pioptr->dir) | (1 << offset), 64a9aec7feSAtsushi Nemoto &txx9_pioptr->dir); 65a9aec7feSAtsushi Nemoto mmiowb(); 66a9aec7feSAtsushi Nemoto spin_unlock_irq(&txx9_gpio_lock); 67a9aec7feSAtsushi Nemoto return 0; 68a9aec7feSAtsushi Nemoto } 69a9aec7feSAtsushi Nemoto 70a9aec7feSAtsushi Nemoto static struct gpio_chip txx9_gpio_chip = { 71a9aec7feSAtsushi Nemoto .get = txx9_gpio_get, 72a9aec7feSAtsushi Nemoto .set = txx9_gpio_set, 73a9aec7feSAtsushi Nemoto .direction_input = txx9_gpio_dir_in, 74a9aec7feSAtsushi Nemoto .direction_output = txx9_gpio_dir_out, 75a9aec7feSAtsushi Nemoto .label = "TXx9", 76a9aec7feSAtsushi Nemoto }; 77a9aec7feSAtsushi Nemoto 78a9aec7feSAtsushi Nemoto int __init txx9_gpio_init(unsigned long baseaddr, 79a9aec7feSAtsushi Nemoto unsigned int base, unsigned int num) 80a9aec7feSAtsushi Nemoto { 81a9aec7feSAtsushi Nemoto txx9_pioptr = ioremap(baseaddr, sizeof(struct txx9_pio_reg)); 82a9aec7feSAtsushi Nemoto if (!txx9_pioptr) 83a9aec7feSAtsushi Nemoto return -ENODEV; 84a9aec7feSAtsushi Nemoto txx9_gpio_chip.base = base; 85a9aec7feSAtsushi Nemoto txx9_gpio_chip.ngpio = num; 86a9aec7feSAtsushi Nemoto return gpiochip_add(&txx9_gpio_chip); 87a9aec7feSAtsushi Nemoto } 88