git.oblomov.eu Git - linux-2.6/blob - arch/avr32/mach-at32ap/sm.c

   1 /*
   2  * System Manager driver for AT32AP CPUs
   3  *
   4  * Copyright (C) 2006 Atmel Corporation
   5  *
   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.
   9  */
  10
  11 #include <linux/errno.h>
  12 #include <linux/init.h>
  13 #include <linux/interrupt.h>
  14 #include <linux/kernel.h>
  15 #include <linux/platform_device.h>
  16 #include <linux/random.h>
  17 #include <linux/spinlock.h>
  18
  19 #include <asm/intc.h>
  20 #include <asm/io.h>
  21 #include <asm/irq.h>
  22
  23 #include <asm/arch/sm.h>
  24
  25 #include "sm.h"
  26
  27 #define SM_EIM_IRQ_RESOURCE     1
  28 #define SM_PM_IRQ_RESOURCE      2
  29 #define SM_RTC_IRQ_RESOURCE     3
  30
  31 #define to_eim(irqc) container_of(irqc, struct at32_sm, irqc)
  32
  33 struct at32_sm system_manager;
  34
  35 int __init at32_sm_init(void)
  36 {
  37         struct resource *regs;
  38         struct at32_sm *sm = &system_manager;
  39         int ret = -ENXIO;
  40
  41         regs = platform_get_resource(&at32_sm_device, IORESOURCE_MEM, 0);
  42         if (!regs)
  43                 goto fail;
  44
  45         spin_lock_init(&sm->lock);
  46         sm->pdev = &at32_sm_device;
  47
  48         ret = -ENOMEM;
  49         sm->regs = ioremap(regs->start, regs->end - regs->start + 1);
  50         if (!sm->regs)
  51                 goto fail;
  52
  53         return 0;
  54
  55 fail:
  56         printk(KERN_ERR "Failed to initialize System Manager: %d\n", ret);
  57         return ret;
  58 }
  59
  60 /*
  61  * External Interrupt Module (EIM).
  62  *
  63  * EIM gets level- or edge-triggered interrupts of either polarity
  64  * from the outside and converts it to active-high level-triggered
  65  * interrupts that the internal interrupt controller can handle. EIM
  66  * also provides masking/unmasking of interrupts, as well as
  67  * acknowledging of edge-triggered interrupts.
  68  */
  69
  70 static irqreturn_t spurious_eim_interrupt(int irq, void *dev_id,
  71                                           struct pt_regs *regs)
  72 {
  73         printk(KERN_WARNING "Spurious EIM interrupt %d\n", irq);
  74         disable_irq(irq);
  75         return IRQ_NONE;
  76 }
  77
  78 static struct irqaction eim_spurious_action = {
  79         .handler = spurious_eim_interrupt,
  80 };
  81
  82 static irqreturn_t eim_handle_irq(int irq, void *dev_id, struct pt_regs *regs)
  83 {
  84         struct irq_controller * irqc = dev_id;
  85         struct at32_sm *sm = to_eim(irqc);
  86         unsigned long pending;
  87
  88         /*
  89          * No need to disable interrupts globally.  The interrupt
  90          * level relevant to this group must be masked all the time,
  91          * so we know that this particular EIM instance will not be
  92          * re-entered.
  93          */
  94         spin_lock(&sm->lock);
  95
  96         pending = intc_get_pending(sm->irqc.irq_group);
  97         if (unlikely(!pending)) {
  98                 printk(KERN_ERR "EIM (group %u): No interrupts pending!\n",
  99                        sm->irqc.irq_group);
 100                 goto unlock;
 101         }
 102
 103         do {
 104                 struct irqaction *action;
 105                 unsigned int i;
 106
 107                 i = fls(pending) - 1;
 108                 pending &= ~(1 << i);
 109                 action = sm->action[i];
 110
 111                 /* Acknowledge the interrupt */
 112                 sm_writel(sm, EIM_ICR, 1 << i);
 113
 114                 spin_unlock(&sm->lock);
 115
 116                 if (action->flags & SA_INTERRUPT)
 117                         local_irq_disable();
 118                 action->handler(sm->irqc.first_irq + i, action->dev_id, regs);
 119                 local_irq_enable();
 120                 spin_lock(&sm->lock);
 121                 if (action->flags & SA_SAMPLE_RANDOM)
 122                         add_interrupt_randomness(sm->irqc.first_irq + i);
 123         } while (pending);
 124
 125 unlock:
 126         spin_unlock(&sm->lock);
 127         return IRQ_HANDLED;
 128 }
 129
 130 static void eim_mask(struct irq_controller *irqc, unsigned int irq)
 131 {
 132         struct at32_sm *sm = to_eim(irqc);
 133         unsigned int i;
 134
 135         i = irq - sm->irqc.first_irq;
 136         sm_writel(sm, EIM_IDR, 1 << i);
 137 }
 138
 139 static void eim_unmask(struct irq_controller *irqc, unsigned int irq)
 140 {
 141         struct at32_sm *sm = to_eim(irqc);
 142         unsigned int i;
 143
 144         i = irq - sm->irqc.first_irq;
 145         sm_writel(sm, EIM_IER, 1 << i);
 146 }
 147
 148 static int eim_setup(struct irq_controller *irqc, unsigned int irq,
 149                 struct irqaction *action)
 150 {
 151         struct at32_sm *sm = to_eim(irqc);
 152         sm->action[irq - sm->irqc.first_irq] = action;
 153         /* Acknowledge earlier interrupts */
 154         sm_writel(sm, EIM_ICR, (1<<(irq - sm->irqc.first_irq)));
 155         eim_unmask(irqc, irq);
 156         return 0;
 157 }
 158
 159 static void eim_free(struct irq_controller *irqc, unsigned int irq,
 160                 void *dev)
 161 {
 162         struct at32_sm *sm = to_eim(irqc);
 163         eim_mask(irqc, irq);
 164         sm->action[irq - sm->irqc.first_irq] = &eim_spurious_action;
 165 }
 166
 167 static int eim_set_type(struct irq_controller *irqc, unsigned int irq,
 168                         unsigned int type)
 169 {
 170         struct at32_sm *sm = to_eim(irqc);
 171         unsigned long flags;
 172         u32 value, pattern;
 173
 174         spin_lock_irqsave(&sm->lock, flags);
 175
 176         pattern = 1 << (irq - sm->irqc.first_irq);
 177
 178         value = sm_readl(sm, EIM_MODE);
 179         if (type & IRQ_TYPE_LEVEL)
 180                 value |= pattern;
 181         else
 182                 value &= ~pattern;
 183         sm_writel(sm, EIM_MODE, value);
 184         value = sm_readl(sm, EIM_EDGE);
 185         if (type & IRQ_EDGE_RISING)
 186                 value |= pattern;
 187         else
 188                 value &= ~pattern;
 189         sm_writel(sm, EIM_EDGE, value);
 190         value = sm_readl(sm, EIM_LEVEL);
 191         if (type & IRQ_LEVEL_HIGH)
 192                 value |= pattern;
 193         else
 194                 value &= ~pattern;
 195         sm_writel(sm, EIM_LEVEL, value);
 196
 197         spin_unlock_irqrestore(&sm->lock, flags);
 198
 199         return 0;
 200 }
 201
 202 static unsigned int eim_get_type(struct irq_controller *irqc,
 203                                  unsigned int irq)
 204 {
 205         struct at32_sm *sm = to_eim(irqc);
 206         unsigned long flags;
 207         unsigned int type = 0;
 208         u32 mode, edge, level, pattern;
 209
 210         pattern = 1 << (irq - sm->irqc.first_irq);
 211
 212         spin_lock_irqsave(&sm->lock, flags);
 213         mode = sm_readl(sm, EIM_MODE);
 214         edge = sm_readl(sm, EIM_EDGE);
 215         level = sm_readl(sm, EIM_LEVEL);
 216         spin_unlock_irqrestore(&sm->lock, flags);
 217
 218         if (mode & pattern)
 219                 type |= IRQ_TYPE_LEVEL;
 220         if (edge & pattern)
 221                 type |= IRQ_EDGE_RISING;
 222         if (level & pattern)
 223                 type |= IRQ_LEVEL_HIGH;
 224
 225         return type;
 226 }
 227
 228 static struct irq_controller_class eim_irq_class = {
 229         .typename       = "EIM",
 230         .handle         = eim_handle_irq,
 231         .setup          = eim_setup,
 232         .free           = eim_free,
 233         .mask           = eim_mask,
 234         .unmask         = eim_unmask,
 235         .set_type       = eim_set_type,
 236         .get_type       = eim_get_type,
 237 };
 238
 239 static int __init eim_init(void)
 240 {
 241         struct at32_sm *sm = &system_manager;
 242         unsigned int i;
 243         u32 pattern;
 244         int ret;
 245
 246         /*
 247          * The EIM is really the same module as SM, so register
 248          * mapping, etc. has been taken care of already.
 249          */
 250
 251         /*
 252          * Find out how many interrupt lines that are actually
 253          * implemented in hardware.
 254          */
 255         sm_writel(sm, EIM_IDR, ~0UL);
 256         sm_writel(sm, EIM_MODE, ~0UL);
 257         pattern = sm_readl(sm, EIM_MODE);
 258         sm->irqc.nr_irqs = fls(pattern);
 259
 260         ret = -ENOMEM;
 261         sm->action = kmalloc(sizeof(*sm->action) * sm->irqc.nr_irqs,
 262                              GFP_KERNEL);
 263         if (!sm->action)
 264                 goto out;
 265
 266         for (i = 0; i < sm->irqc.nr_irqs; i++)
 267                 sm->action[i] = &eim_spurious_action;
 268
 269         spin_lock_init(&sm->lock);
 270         sm->irqc.irq_group = sm->pdev->resource[SM_EIM_IRQ_RESOURCE].start;
 271         sm->irqc.class = &eim_irq_class;
 272
 273         ret = intc_register_controller(&sm->irqc);
 274         if (ret < 0)
 275                 goto out_free_actions;
 276
 277         printk("EIM: External Interrupt Module at 0x%p, IRQ group %u\n",
 278                sm->regs, sm->irqc.irq_group);
 279         printk("EIM: Handling %u external IRQs, starting with IRQ%u\n",
 280                sm->irqc.nr_irqs, sm->irqc.first_irq);
 281
 282         return 0;
 283
 284 out_free_actions:
 285         kfree(sm->action);
 286 out:
 287         return ret;
 288 }
 289 arch_initcall(eim_init);