[PATCH] sibling map initializing rework
[pandora-kernel.git] / arch / i386 / kernel / irq.c
1 /*
2  *      linux/arch/i386/kernel/irq.c
3  *
4  *      Copyright (C) 1992, 1998 Linus Torvalds, Ingo Molnar
5  *
6  * This file contains the lowest level x86-specific interrupt
7  * entry, irq-stacks and irq statistics code. All the remaining
8  * irq logic is done by the generic kernel/irq/ code and
9  * by the x86-specific irq controller code. (e.g. i8259.c and
10  * io_apic.c.)
11  */
12
13 #include <asm/uaccess.h>
14 #include <linux/module.h>
15 #include <linux/seq_file.h>
16 #include <linux/interrupt.h>
17 #include <linux/kernel_stat.h>
18 #include <linux/notifier.h>
19 #include <linux/cpu.h>
20 #include <linux/delay.h>
21
22 DEFINE_PER_CPU(irq_cpustat_t, irq_stat) ____cacheline_maxaligned_in_smp;
23 EXPORT_PER_CPU_SYMBOL(irq_stat);
24
25 #ifndef CONFIG_X86_LOCAL_APIC
26 /*
27  * 'what should we do if we get a hw irq event on an illegal vector'.
28  * each architecture has to answer this themselves.
29  */
30 void ack_bad_irq(unsigned int irq)
31 {
32         printk("unexpected IRQ trap at vector %02x\n", irq);
33 }
34 #endif
35
36 #ifdef CONFIG_4KSTACKS
37 /*
38  * per-CPU IRQ handling contexts (thread information and stack)
39  */
40 union irq_ctx {
41         struct thread_info      tinfo;
42         u32                     stack[THREAD_SIZE/sizeof(u32)];
43 };
44
45 static union irq_ctx *hardirq_ctx[NR_CPUS];
46 static union irq_ctx *softirq_ctx[NR_CPUS];
47 #endif
48
49 /*
50  * do_IRQ handles all normal device IRQ's (the special
51  * SMP cross-CPU interrupts have their own specific
52  * handlers).
53  */
54 fastcall unsigned int do_IRQ(struct pt_regs *regs)
55 {       
56         /* high bits used in ret_from_ code */
57         int irq = regs->orig_eax & 0xff;
58 #ifdef CONFIG_4KSTACKS
59         union irq_ctx *curctx, *irqctx;
60         u32 *isp;
61 #endif
62
63         irq_enter();
64 #ifdef CONFIG_DEBUG_STACKOVERFLOW
65         /* Debugging check for stack overflow: is there less than 1KB free? */
66         {
67                 long esp;
68
69                 __asm__ __volatile__("andl %%esp,%0" :
70                                         "=r" (esp) : "0" (THREAD_SIZE - 1));
71                 if (unlikely(esp < (sizeof(struct thread_info) + STACK_WARN))) {
72                         printk("do_IRQ: stack overflow: %ld\n",
73                                 esp - sizeof(struct thread_info));
74                         dump_stack();
75                 }
76         }
77 #endif
78
79 #ifdef CONFIG_4KSTACKS
80
81         curctx = (union irq_ctx *) current_thread_info();
82         irqctx = hardirq_ctx[smp_processor_id()];
83
84         /*
85          * this is where we switch to the IRQ stack. However, if we are
86          * already using the IRQ stack (because we interrupted a hardirq
87          * handler) we can't do that and just have to keep using the
88          * current stack (which is the irq stack already after all)
89          */
90         if (curctx != irqctx) {
91                 int arg1, arg2, ebx;
92
93                 /* build the stack frame on the IRQ stack */
94                 isp = (u32*) ((char*)irqctx + sizeof(*irqctx));
95                 irqctx->tinfo.task = curctx->tinfo.task;
96                 irqctx->tinfo.previous_esp = current_stack_pointer;
97
98                 asm volatile(
99                         "       xchgl   %%ebx,%%esp      \n"
100                         "       call    __do_IRQ         \n"
101                         "       movl   %%ebx,%%esp      \n"
102                         : "=a" (arg1), "=d" (arg2), "=b" (ebx)
103                         :  "0" (irq),   "1" (regs),  "2" (isp)
104                         : "memory", "cc", "ecx"
105                 );
106         } else
107 #endif
108                 __do_IRQ(irq, regs);
109
110         irq_exit();
111
112         return 1;
113 }
114
115 #ifdef CONFIG_4KSTACKS
116
117 /*
118  * These should really be __section__(".bss.page_aligned") as well, but
119  * gcc's 3.0 and earlier don't handle that correctly.
120  */
121 static char softirq_stack[NR_CPUS * THREAD_SIZE]
122                 __attribute__((__aligned__(THREAD_SIZE)));
123
124 static char hardirq_stack[NR_CPUS * THREAD_SIZE]
125                 __attribute__((__aligned__(THREAD_SIZE)));
126
127 /*
128  * allocate per-cpu stacks for hardirq and for softirq processing
129  */
130 void irq_ctx_init(int cpu)
131 {
132         union irq_ctx *irqctx;
133
134         if (hardirq_ctx[cpu])
135                 return;
136
137         irqctx = (union irq_ctx*) &hardirq_stack[cpu*THREAD_SIZE];
138         irqctx->tinfo.task              = NULL;
139         irqctx->tinfo.exec_domain       = NULL;
140         irqctx->tinfo.cpu               = cpu;
141         irqctx->tinfo.preempt_count     = HARDIRQ_OFFSET;
142         irqctx->tinfo.addr_limit        = MAKE_MM_SEG(0);
143
144         hardirq_ctx[cpu] = irqctx;
145
146         irqctx = (union irq_ctx*) &softirq_stack[cpu*THREAD_SIZE];
147         irqctx->tinfo.task              = NULL;
148         irqctx->tinfo.exec_domain       = NULL;
149         irqctx->tinfo.cpu               = cpu;
150         irqctx->tinfo.preempt_count     = SOFTIRQ_OFFSET;
151         irqctx->tinfo.addr_limit        = MAKE_MM_SEG(0);
152
153         softirq_ctx[cpu] = irqctx;
154
155         printk("CPU %u irqstacks, hard=%p soft=%p\n",
156                 cpu,hardirq_ctx[cpu],softirq_ctx[cpu]);
157 }
158
159 extern asmlinkage void __do_softirq(void);
160
161 asmlinkage void do_softirq(void)
162 {
163         unsigned long flags;
164         struct thread_info *curctx;
165         union irq_ctx *irqctx;
166         u32 *isp;
167
168         if (in_interrupt())
169                 return;
170
171         local_irq_save(flags);
172
173         if (local_softirq_pending()) {
174                 curctx = current_thread_info();
175                 irqctx = softirq_ctx[smp_processor_id()];
176                 irqctx->tinfo.task = curctx->task;
177                 irqctx->tinfo.previous_esp = current_stack_pointer;
178
179                 /* build the stack frame on the softirq stack */
180                 isp = (u32*) ((char*)irqctx + sizeof(*irqctx));
181
182                 asm volatile(
183                         "       xchgl   %%ebx,%%esp     \n"
184                         "       call    __do_softirq    \n"
185                         "       movl    %%ebx,%%esp     \n"
186                         : "=b"(isp)
187                         : "0"(isp)
188                         : "memory", "cc", "edx", "ecx", "eax"
189                 );
190         }
191
192         local_irq_restore(flags);
193 }
194
195 EXPORT_SYMBOL(do_softirq);
196 #endif
197
198 /*
199  * Interrupt statistics:
200  */
201
202 atomic_t irq_err_count;
203
204 /*
205  * /proc/interrupts printing:
206  */
207
208 int show_interrupts(struct seq_file *p, void *v)
209 {
210         int i = *(loff_t *) v, j;
211         struct irqaction * action;
212         unsigned long flags;
213
214         if (i == 0) {
215                 seq_printf(p, "           ");
216                 for_each_cpu(j)
217                         seq_printf(p, "CPU%d       ",j);
218                 seq_putc(p, '\n');
219         }
220
221         if (i < NR_IRQS) {
222                 spin_lock_irqsave(&irq_desc[i].lock, flags);
223                 action = irq_desc[i].action;
224                 if (!action)
225                         goto skip;
226                 seq_printf(p, "%3d: ",i);
227 #ifndef CONFIG_SMP
228                 seq_printf(p, "%10u ", kstat_irqs(i));
229 #else
230                 for_each_cpu(j)
231                         seq_printf(p, "%10u ", kstat_cpu(j).irqs[i]);
232 #endif
233                 seq_printf(p, " %14s", irq_desc[i].handler->typename);
234                 seq_printf(p, "  %s", action->name);
235
236                 for (action=action->next; action; action = action->next)
237                         seq_printf(p, ", %s", action->name);
238
239                 seq_putc(p, '\n');
240 skip:
241                 spin_unlock_irqrestore(&irq_desc[i].lock, flags);
242         } else if (i == NR_IRQS) {
243                 seq_printf(p, "NMI: ");
244                 for_each_cpu(j)
245                         seq_printf(p, "%10u ", nmi_count(j));
246                 seq_putc(p, '\n');
247 #ifdef CONFIG_X86_LOCAL_APIC
248                 seq_printf(p, "LOC: ");
249                 for_each_cpu(j)
250                         seq_printf(p, "%10u ",
251                                 per_cpu(irq_stat,j).apic_timer_irqs);
252                 seq_putc(p, '\n');
253 #endif
254                 seq_printf(p, "ERR: %10u\n", atomic_read(&irq_err_count));
255 #if defined(CONFIG_X86_IO_APIC)
256                 seq_printf(p, "MIS: %10u\n", atomic_read(&irq_mis_count));
257 #endif
258         }
259         return 0;
260 }
261
262 #ifdef CONFIG_HOTPLUG_CPU
263 #include <mach_apic.h>
264
265 void fixup_irqs(cpumask_t map)
266 {
267         unsigned int irq;
268         static int warned;
269
270         for (irq = 0; irq < NR_IRQS; irq++) {
271                 cpumask_t mask;
272                 if (irq == 2)
273                         continue;
274
275                 cpus_and(mask, irq_affinity[irq], map);
276                 if (any_online_cpu(mask) == NR_CPUS) {
277                         printk("Breaking affinity for irq %i\n", irq);
278                         mask = map;
279                 }
280                 if (irq_desc[irq].handler->set_affinity)
281                         irq_desc[irq].handler->set_affinity(irq, mask);
282                 else if (irq_desc[irq].action && !(warned++))
283                         printk("Cannot set affinity for irq %i\n", irq);
284         }
285
286 #if 0
287         barrier();
288         /* Ingo Molnar says: "after the IO-APIC masks have been redirected
289            [note the nop - the interrupt-enable boundary on x86 is two
290            instructions from sti] - to flush out pending hardirqs and
291            IPIs. After this point nothing is supposed to reach this CPU." */
292         __asm__ __volatile__("sti; nop; cli");
293         barrier();
294 #else
295         /* That doesn't seem sufficient.  Give it 1ms. */
296         local_irq_enable();
297         mdelay(1);
298         local_irq_disable();
299 #endif
300 }
301 #endif
302