git.oblomov.eu Git - linux-2.6/blob - arch/x86/kernel/irq_32.c

   1 /*
   2  *      Copyright (C) 1992, 1998 Linus Torvalds, Ingo Molnar
   3  *
   4  * This file contains the lowest level x86-specific interrupt
   5  * entry, irq-stacks and irq statistics code. All the remaining
   6  * irq logic is done by the generic kernel/irq/ code and
   7  * by the x86-specific irq controller code. (e.g. i8259.c and
   8  * io_apic.c.)
   9  */
  10
  11 #include <linux/module.h>
  12 #include <linux/seq_file.h>
  13 #include <linux/interrupt.h>
  14 #include <linux/kernel_stat.h>
  15 #include <linux/notifier.h>
  16 #include <linux/cpu.h>
  17 #include <linux/delay.h>
  18 #include <linux/uaccess.h>
  19
  20 #include <asm/apic.h>
  21
  22 DEFINE_PER_CPU_SHARED_ALIGNED(irq_cpustat_t, irq_stat);
  23 EXPORT_PER_CPU_SYMBOL(irq_stat);
  24
  25 DEFINE_PER_CPU(struct pt_regs *, irq_regs);
  26 EXPORT_PER_CPU_SYMBOL(irq_regs);
  27
  28 #ifdef CONFIG_DEBUG_STACKOVERFLOW
  29 /* Debugging check for stack overflow: is there less than 1KB free? */
  30 static int check_stack_overflow(void)
  31 {
  32         long sp;
  33
  34         __asm__ __volatile__("andl %%esp,%0" :
  35                              "=r" (sp) : "0" (THREAD_SIZE - 1));
  36
  37         return sp < (sizeof(struct thread_info) + STACK_WARN);
  38 }
  39
  40 static void print_stack_overflow(void)
  41 {
  42         printk(KERN_WARNING "low stack detected by irq handler\n");
  43         dump_stack();
  44 }
  45
  46 #else
  47 static inline int check_stack_overflow(void) { return 0; }
  48 static inline void print_stack_overflow(void) { }
  49 #endif
  50
  51 #ifdef CONFIG_4KSTACKS
  52 /*
  53  * per-CPU IRQ handling contexts (thread information and stack)
  54  */
  55 union irq_ctx {
  56         struct thread_info      tinfo;
  57         u32                     stack[THREAD_SIZE/sizeof(u32)];
  58 };
  59
  60 static union irq_ctx *hardirq_ctx[NR_CPUS] __read_mostly;
  61 static union irq_ctx *softirq_ctx[NR_CPUS] __read_mostly;
  62
  63 static char softirq_stack[NR_CPUS * THREAD_SIZE] __page_aligned_bss;
  64 static char hardirq_stack[NR_CPUS * THREAD_SIZE] __page_aligned_bss;
  65
  66 static void call_on_stack(void *func, void *stack)
  67 {
  68         asm volatile("xchgl     %%ebx,%%esp     \n"
  69                      "call      *%%edi          \n"
  70                      "movl      %%ebx,%%esp     \n"
  71                      : "=b" (stack)
  72                      : "0" (stack),
  73                        "D"(func)
  74                      : "memory", "cc", "edx", "ecx", "eax");
  75 }
  76
  77 static inline int
  78 execute_on_irq_stack(int overflow, struct irq_desc *desc, int irq)
  79 {
  80         union irq_ctx *curctx, *irqctx;
  81         u32 *isp, arg1, arg2;
  82
  83         curctx = (union irq_ctx *) current_thread_info();
  84         irqctx = hardirq_ctx[smp_processor_id()];
  85
  86         /*
  87          * this is where we switch to the IRQ stack. However, if we are
  88          * already using the IRQ stack (because we interrupted a hardirq
  89          * handler) we can't do that and just have to keep using the
  90          * current stack (which is the irq stack already after all)
  91          */
  92         if (unlikely(curctx == irqctx))
  93                 return 0;
  94
  95         /* build the stack frame on the IRQ stack */
  96         isp = (u32 *) ((char *)irqctx + sizeof(*irqctx));
  97         irqctx->tinfo.task = curctx->tinfo.task;
  98         irqctx->tinfo.previous_esp = current_stack_pointer;
  99
 100         /*
 101          * Copy the softirq bits in preempt_count so that the
 102          * softirq checks work in the hardirq context.
 103          */
 104         irqctx->tinfo.preempt_count =
 105                 (irqctx->tinfo.preempt_count & ~SOFTIRQ_MASK) |
 106                 (curctx->tinfo.preempt_count & SOFTIRQ_MASK);
 107
 108         if (unlikely(overflow))
 109                 call_on_stack(print_stack_overflow, isp);
 110
 111         asm volatile("xchgl     %%ebx,%%esp     \n"
 112                      "call      *%%edi          \n"
 113                      "movl      %%ebx,%%esp     \n"
 114                      : "=a" (arg1), "=d" (arg2), "=b" (isp)
 115                      :  "0" (irq),   "1" (desc),  "2" (isp),
 116                         "D" (desc->handle_irq)
 117                      : "memory", "cc", "ecx");
 118         return 1;
 119 }
 120
 121 /*
 122  * allocate per-cpu stacks for hardirq and for softirq processing
 123  */
 124 void __cpuinit irq_ctx_init(int cpu)
 125 {
 126         union irq_ctx *irqctx;
 127
 128         if (hardirq_ctx[cpu])
 129                 return;
 130
 131         irqctx = (union irq_ctx*) &hardirq_stack[cpu*THREAD_SIZE];
 132         irqctx->tinfo.task              = NULL;
 133         irqctx->tinfo.exec_domain       = NULL;
 134         irqctx->tinfo.cpu               = cpu;
 135         irqctx->tinfo.preempt_count     = HARDIRQ_OFFSET;
 136         irqctx->tinfo.addr_limit        = MAKE_MM_SEG(0);
 137
 138         hardirq_ctx[cpu] = irqctx;
 139
 140         irqctx = (union irq_ctx *) &softirq_stack[cpu*THREAD_SIZE];
 141         irqctx->tinfo.task              = NULL;
 142         irqctx->tinfo.exec_domain       = NULL;
 143         irqctx->tinfo.cpu               = cpu;
 144         irqctx->tinfo.preempt_count     = 0;
 145         irqctx->tinfo.addr_limit        = MAKE_MM_SEG(0);
 146
 147         softirq_ctx[cpu] = irqctx;
 148
 149         printk(KERN_DEBUG "CPU %u irqstacks, hard=%p soft=%p\n",
 150                cpu, hardirq_ctx[cpu], softirq_ctx[cpu]);
 151 }
 152
 153 void irq_ctx_exit(int cpu)
 154 {
 155         hardirq_ctx[cpu] = NULL;
 156 }
 157
 158 asmlinkage void do_softirq(void)
 159 {
 160         unsigned long flags;
 161         struct thread_info *curctx;
 162         union irq_ctx *irqctx;
 163         u32 *isp;
 164
 165         if (in_interrupt())
 166                 return;
 167
 168         local_irq_save(flags);
 169
 170         if (local_softirq_pending()) {
 171                 curctx = current_thread_info();
 172                 irqctx = softirq_ctx[smp_processor_id()];
 173                 irqctx->tinfo.task = curctx->task;
 174                 irqctx->tinfo.previous_esp = current_stack_pointer;
 175
 176                 /* build the stack frame on the softirq stack */
 177                 isp = (u32 *) ((char *)irqctx + sizeof(*irqctx));
 178
 179                 call_on_stack(__do_softirq, isp);
 180                 /*
 181                  * Shouldnt happen, we returned above if in_interrupt():
 182                  */
 183                 WARN_ON_ONCE(softirq_count());
 184         }
 185
 186         local_irq_restore(flags);
 187 }
 188
 189 #else
 190 static inline int
 191 execute_on_irq_stack(int overflow, struct irq_desc *desc, int irq) { return 0; }
 192 #endif
 193
 194 /*
 195  * do_IRQ handles all normal device IRQ's (the special
 196  * SMP cross-CPU interrupts have their own specific
 197  * handlers).
 198  */
 199 unsigned int do_IRQ(struct pt_regs *regs)
 200 {
 201         struct pt_regs *old_regs;
 202         /* high bit used in ret_from_ code */
 203         int overflow;
 204         unsigned vector = ~regs->orig_ax;
 205         struct irq_desc *desc;
 206         unsigned irq;
 207
 208
 209         old_regs = set_irq_regs(regs);
 210         irq_enter();
 211         irq = __get_cpu_var(vector_irq)[vector];
 212
 213         overflow = check_stack_overflow();
 214
 215         desc = irq_to_desc(irq);
 216         if (unlikely(!desc)) {
 217                 printk(KERN_EMERG "%s: cannot handle IRQ %d vector %#x cpu %d\n",
 218                                         __func__, irq, vector, smp_processor_id());
 219                 BUG();
 220         }
 221
 222         if (!execute_on_irq_stack(overflow, desc, irq)) {
 223                 if (unlikely(overflow))
 224                         print_stack_overflow();
 225                 desc->handle_irq(irq, desc);
 226         }
 227
 228         irq_exit();
 229         set_irq_regs(old_regs);
 230         return 1;
 231 }
 232
 233 #ifdef CONFIG_HOTPLUG_CPU
 234 #include <mach_apic.h>
 235
 236 /* A cpu has been removed from cpu_online_mask.  Reset irq affinities. */
 237 void fixup_irqs(void)
 238 {
 239         unsigned int irq;
 240         static int warned;
 241         struct irq_desc *desc;
 242
 243         for_each_irq_desc(irq, desc) {
 244                 const struct cpumask *affinity;
 245
 246                 if (!desc)
 247                         continue;
 248                 if (irq == 2)
 249                         continue;
 250
 251                 affinity = &desc->affinity;
 252                 if (cpumask_any_and(affinity, cpu_online_mask) >= nr_cpu_ids) {
 253                         printk("Breaking affinity for irq %i\n", irq);
 254                         affinity = cpu_all_mask;
 255                 }
 256                 if (desc->chip->set_affinity)
 257                         desc->chip->set_affinity(irq, affinity);
 258                 else if (desc->action && !(warned++))
 259                         printk("Cannot set affinity for irq %i\n", irq);
 260         }
 261
 262 #if 0
 263         barrier();
 264         /* Ingo Molnar says: "after the IO-APIC masks have been redirected
 265            [note the nop - the interrupt-enable boundary on x86 is two
 266            instructions from sti] - to flush out pending hardirqs and
 267            IPIs. After this point nothing is supposed to reach this CPU." */
 268         __asm__ __volatile__("sti; nop; cli");
 269         barrier();
 270 #else
 271         /* That doesn't seem sufficient.  Give it 1ms. */
 272         local_irq_enable();
 273         mdelay(1);
 274         local_irq_disable();
 275 #endif
 276 }
 277 #endif
 278