arch/arm/plat-s5p/irq-gpioint.c

   1 /* linux/arch/arm/plat-s5p/irq-gpioint.c
   2  *
   3  * Copyright (c) 2010 Samsung Electronics Co., Ltd.
   4  * Author: Kyungmin Park <kyungmin.park@samsung.com>
   5  * Author: Joonyoung Shim <jy0922.shim@samsung.com>
   6  * Author: Marek Szyprowski <m.szyprowski@samsung.com>
   7  *
   8  *  This program is free software; you can redistribute  it and/or modify it
   9  *  under  the terms of  the GNU General  Public License as published by the
  10  *  Free Software Foundation;  either version 2 of the  License, or (at your
  11  *  option) any later version.
  12  *
  13  */
  14
  15 #include <linux/kernel.h>
  16 #include <linux/interrupt.h>
  17 #include <linux/irq.h>
  18 #include <linux/io.h>
  19 #include <linux/gpio.h>
  20 #include <linux/slab.h>
  21
  22 #include <mach/map.h>
  23 #include <plat/gpio-core.h>
  24 #include <plat/gpio-cfg.h>
  25
  26 #define GPIO_BASE(chip)         (((unsigned long)(chip)->base) & 0xFFFFF000u)
  27
  28 #define CON_OFFSET              0x700
  29 #define MASK_OFFSET             0x900
  30 #define PEND_OFFSET             0xA00
  31 #define REG_OFFSET(x)           ((x) << 2)
  32
  33 struct s5p_gpioint_bank {
  34         struct list_head        list;
  35         int                     start;
  36         int                     nr_groups;
  37         int                     irq;
  38         struct s3c_gpio_chip    **chips;
  39         void                    (*handler)(unsigned int, struct irq_desc *);
  40 };
  41
  42 LIST_HEAD(banks);
  43
  44 static int s5p_gpioint_get_offset(struct irq_data *data)
  45 {
  46         struct s3c_gpio_chip *chip = irq_data_get_irq_handler_data(data);
  47         return data->irq - chip->irq_base;
  48 }
  49
  50 static void s5p_gpioint_ack(struct irq_data *data)
  51 {
  52         struct s3c_gpio_chip *chip = irq_data_get_irq_handler_data(data);
  53         int group, offset, pend_offset;
  54         unsigned int value;
  55
  56         group = chip->group;
  57         offset = s5p_gpioint_get_offset(data);
  58         pend_offset = REG_OFFSET(group);
  59
  60         value = __raw_readl(GPIO_BASE(chip) + PEND_OFFSET + pend_offset);
  61         value |= BIT(offset);
  62         __raw_writel(value, GPIO_BASE(chip) + PEND_OFFSET + pend_offset);
  63 }
  64
  65 static void s5p_gpioint_mask(struct irq_data *data)
  66 {
  67         struct s3c_gpio_chip *chip = irq_data_get_irq_handler_data(data);
  68         int group, offset, mask_offset;
  69         unsigned int value;
  70
  71         group = chip->group;
  72         offset = s5p_gpioint_get_offset(data);
  73         mask_offset = REG_OFFSET(group);
  74
  75         value = __raw_readl(GPIO_BASE(chip) + MASK_OFFSET + mask_offset);
  76         value |= BIT(offset);
  77         __raw_writel(value, GPIO_BASE(chip) + MASK_OFFSET + mask_offset);
  78 }
  79
  80 static void s5p_gpioint_unmask(struct irq_data *data)
  81 {
  82         struct s3c_gpio_chip *chip = irq_data_get_irq_handler_data(data);
  83         int group, offset, mask_offset;
  84         unsigned int value;
  85
  86         group = chip->group;
  87         offset = s5p_gpioint_get_offset(data);
  88         mask_offset = REG_OFFSET(group);
  89
  90         value = __raw_readl(GPIO_BASE(chip) + MASK_OFFSET + mask_offset);
  91         value &= ~BIT(offset);
  92         __raw_writel(value, GPIO_BASE(chip) + MASK_OFFSET + mask_offset);
  93 }
  94
  95 static void s5p_gpioint_mask_ack(struct irq_data *data)
  96 {
  97         s5p_gpioint_mask(data);
  98         s5p_gpioint_ack(data);
  99 }
 100
 101 static int s5p_gpioint_set_type(struct irq_data *data, unsigned int type)
 102 {
 103         struct s3c_gpio_chip *chip = irq_data_get_irq_handler_data(data);
 104         int group, offset, con_offset;
 105         unsigned int value;
 106
 107         group = chip->group;
 108         offset = s5p_gpioint_get_offset(data);
 109         con_offset = REG_OFFSET(group);
 110
 111         switch (type) {
 112         case IRQ_TYPE_EDGE_RISING:
 113                 type = S5P_IRQ_TYPE_EDGE_RISING;
 114                 break;
 115         case IRQ_TYPE_EDGE_FALLING:
 116                 type = S5P_IRQ_TYPE_EDGE_FALLING;
 117                 break;
 118         case IRQ_TYPE_EDGE_BOTH:
 119                 type = S5P_IRQ_TYPE_EDGE_BOTH;
 120                 break;
 121         case IRQ_TYPE_LEVEL_HIGH:
 122                 type = S5P_IRQ_TYPE_LEVEL_HIGH;
 123                 break;
 124         case IRQ_TYPE_LEVEL_LOW:
 125                 type = S5P_IRQ_TYPE_LEVEL_LOW;
 126                 break;
 127         case IRQ_TYPE_NONE:
 128         default:
 129                 printk(KERN_WARNING "No irq type\n");
 130                 return -EINVAL;
 131         }
 132
 133         value = __raw_readl(GPIO_BASE(chip) + CON_OFFSET + con_offset);
 134         value &= ~(0x7 << (offset * 0x4));
 135         value |= (type << (offset * 0x4));
 136         __raw_writel(value, GPIO_BASE(chip) + CON_OFFSET + con_offset);
 137
 138         return 0;
 139 }
 140
 141 static struct irq_chip s5p_gpioint = {
 142         .name           = "s5p_gpioint",
 143         .irq_ack        = s5p_gpioint_ack,
 144         .irq_mask       = s5p_gpioint_mask,
 145         .irq_mask_ack   = s5p_gpioint_mask_ack,
 146         .irq_unmask     = s5p_gpioint_unmask,
 147         .irq_set_type   = s5p_gpioint_set_type,
 148 };
 149
 150 static void s5p_gpioint_handler(unsigned int irq, struct irq_desc *desc)
 151 {
 152         struct s5p_gpioint_bank *bank = irq_get_handler_data(irq);
 153         int group, pend_offset, mask_offset;
 154         unsigned int pend, mask;
 155
 156         for (group = 0; group < bank->nr_groups; group++) {
 157                 struct s3c_gpio_chip *chip = bank->chips[group];
 158                 if (!chip)
 159                         continue;
 160
 161                 pend_offset = REG_OFFSET(group);
 162                 pend = __raw_readl(GPIO_BASE(chip) + PEND_OFFSET + pend_offset);
 163                 if (!pend)
 164                         continue;
 165
 166                 mask_offset = REG_OFFSET(group);
 167                 mask = __raw_readl(GPIO_BASE(chip) + MASK_OFFSET + mask_offset);
 168                 pend &= ~mask;
 169
 170                 while (pend) {
 171                         int offset = fls(pend) - 1;
 172                         int real_irq = chip->irq_base + offset;
 173                         generic_handle_irq(real_irq);
 174                         pend &= ~BIT(offset);
 175                 }
 176         }
 177 }
 178
 179 static __init int s5p_gpioint_add(struct s3c_gpio_chip *chip)
 180 {
 181         static int used_gpioint_groups = 0;
 182         int irq, group = chip->group;
 183         int i;
 184         struct s5p_gpioint_bank *bank = NULL;
 185
 186         if (used_gpioint_groups >= S5P_GPIOINT_GROUP_COUNT)
 187                 return -ENOMEM;
 188
 189         list_for_each_entry(bank, &banks, list) {
 190                 if (group >= bank->start &&
 191                     group < bank->start + bank->nr_groups)
 192                         break;
 193         }
 194         if (!bank)
 195                 return -EINVAL;
 196
 197         if (!bank->handler) {
 198                 bank->chips = kzalloc(sizeof(struct s3c_gpio_chip *) *
 199                                       bank->nr_groups, GFP_KERNEL);
 200                 if (!bank->chips)
 201                         return -ENOMEM;
 202
 203                 irq_set_chained_handler(bank->irq, s5p_gpioint_handler);
 204                 irq_set_handler_data(bank->irq, bank);
 205                 bank->handler = s5p_gpioint_handler;
 206                 printk(KERN_INFO "Registered chained gpio int handler for interrupt %d.\n",
 207                        bank->irq);
 208         }
 209
 210         /*
 211          * chained GPIO irq has been sucessfully registered, allocate new gpio
 212          * int group and assign irq nubmers
 213          */
 214
 215         chip->irq_base = S5P_GPIOINT_BASE +
 216                          used_gpioint_groups * S5P_GPIOINT_GROUP_SIZE;
 217         used_gpioint_groups++;
 218
 219         bank->chips[group - bank->start] = chip;
 220         for (i = 0; i < chip->chip.ngpio; i++) {
 221                 irq = chip->irq_base + i;
 222                 irq_set_chip(irq, &s5p_gpioint);
 223                 irq_set_handler_data(irq, chip);
 224                 irq_set_handler(irq, handle_level_irq);
 225                 set_irq_flags(irq, IRQF_VALID);
 226         }
 227         return 0;
 228 }
 229
 230 int __init s5p_register_gpio_interrupt(int pin)
 231 {
 232         struct s3c_gpio_chip *my_chip = s3c_gpiolib_getchip(pin);
 233         int offset, group;
 234         int ret;
 235
 236         if (!my_chip)
 237                 return -EINVAL;
 238
 239         offset = pin - my_chip->chip.base;
 240         group = my_chip->group;
 241
 242         /* check if the group has been already registered */
 243         if (my_chip->irq_base)
 244                 return my_chip->irq_base + offset;
 245
 246         /* register gpio group */
 247         ret = s5p_gpioint_add(my_chip);
 248         if (ret == 0) {
 249                 my_chip->chip.to_irq = samsung_gpiolib_to_irq;
 250                 printk(KERN_INFO "Registered interrupt support for gpio group %d.\n",
 251                        group);
 252                 return my_chip->irq_base + offset;
 253         }
 254         return ret;
 255 }
 256
 257 int __init s5p_register_gpioint_bank(int chain_irq, int start, int nr_groups)
 258 {
 259         struct s5p_gpioint_bank *bank;
 260
 261         bank = kzalloc(sizeof(*bank), GFP_KERNEL);
 262         if (!bank)
 263                 return -ENOMEM;
 264
 265         bank->start = start;
 266         bank->nr_groups = nr_groups;
 267         bank->irq = chain_irq;
 268
 269         list_add_tail(&bank->list, &banks);
 270         return 0;
 271 }