x86: remove ioapic_force
[deliverable/linux.git] / arch / x86 / kernel / io_apic_32.c
CommitLineData
1da177e4
LT
1/*
2 * Intel IO-APIC support for multi-Pentium hosts.
3 *
4 * Copyright (C) 1997, 1998, 1999, 2000 Ingo Molnar, Hajnalka Szabo
5 *
6 * Many thanks to Stig Venaas for trying out countless experimental
7 * patches and reporting/debugging problems patiently!
8 *
9 * (c) 1999, Multiple IO-APIC support, developed by
10 * Ken-ichi Yaku <yaku@css1.kbnes.nec.co.jp> and
11 * Hidemi Kishimoto <kisimoto@css1.kbnes.nec.co.jp>,
12 * further tested and cleaned up by Zach Brown <zab@redhat.com>
13 * and Ingo Molnar <mingo@redhat.com>
14 *
15 * Fixes
16 * Maciej W. Rozycki : Bits for genuine 82489DX APICs;
17 * thanks to Eric Gilmore
18 * and Rolf G. Tews
19 * for testing these extensively
20 * Paul Diefenbaugh : Added full ACPI support
21 */
22
23#include <linux/mm.h>
1da177e4
LT
24#include <linux/interrupt.h>
25#include <linux/init.h>
26#include <linux/delay.h>
27#include <linux/sched.h>
d4057bdb 28#include <linux/pci.h>
1da177e4
LT
29#include <linux/mc146818rtc.h>
30#include <linux/compiler.h>
31#include <linux/acpi.h>
129f6946 32#include <linux/module.h>
1da177e4 33#include <linux/sysdev.h>
3b7d1921 34#include <linux/msi.h>
95d77884 35#include <linux/htirq.h>
7dfb7103 36#include <linux/freezer.h>
f26d6a2b 37#include <linux/kthread.h>
d4057bdb
YL
38#include <linux/jiffies.h> /* time_after() */
39#ifdef CONFIG_ACPI
40#include <acpi/acpi_bus.h>
41#endif
42#include <linux/bootmem.h>
43#include <linux/dmar.h>
54d5d424 44
d4057bdb 45#include <asm/idle.h>
1da177e4
LT
46#include <asm/io.h>
47#include <asm/smp.h>
48#include <asm/desc.h>
d4057bdb
YL
49#include <asm/proto.h>
50#include <asm/acpi.h>
51#include <asm/dma.h>
1da177e4 52#include <asm/timer.h>
306e440d 53#include <asm/i8259.h>
3e4ff115 54#include <asm/nmi.h>
2d3fcc1c 55#include <asm/msidef.h>
8b955b0d 56#include <asm/hypertransport.h>
a4dbc34d 57#include <asm/setup.h>
d4057bdb 58#include <asm/irq_remapping.h>
1da177e4 59
497c9a19 60#include <mach_ipi.h>
1da177e4 61#include <mach_apic.h>
874c4fe3 62#include <mach_apicdef.h>
1da177e4 63
32f71aff
MR
64#define __apicdebuginit(type) static type __init
65
1da177e4
LT
66/*
67 * Is the SiS APIC rmw bug present ?
68 * -1 = don't know, 0 = no, 1 = yes
69 */
70int sis_apic_bug = -1;
71
efa2559f
YL
72static DEFINE_SPINLOCK(ioapic_lock);
73static DEFINE_SPINLOCK(vector_lock);
74
301e6190 75int first_free_entry;
efa2559f
YL
76/*
77 * Rough estimation of how many shared IRQs there are, can
78 * be changed anytime.
79 */
80int pin_map_size;
81
1da177e4
LT
82/*
83 * # of IRQ routing registers
84 */
85int nr_ioapic_registers[MAX_IO_APICS];
86
9f640ccb 87/* I/O APIC entries */
ec2cd0a2 88struct mp_config_ioapic mp_ioapics[MAX_IO_APICS];
9f640ccb
AS
89int nr_ioapics;
90
584f734d 91/* MP IRQ source entries */
2fddb6e2 92struct mp_config_intsrc mp_irqs[MAX_IRQ_SOURCES];
584f734d
AS
93
94/* # of MP IRQ source entries */
95int mp_irq_entries;
96
8732fc4b
AS
97#if defined (CONFIG_MCA) || defined (CONFIG_EISA)
98int mp_bus_id_to_type[MAX_MP_BUSSES];
99#endif
100
101DECLARE_BITMAP(mp_bus_not_pci, MAX_MP_BUSSES);
102
efa2559f
YL
103int skip_ioapic_setup;
104
105static int __init parse_noapic(char *arg)
106{
107 /* disable IO-APIC */
108 disable_ioapic_setup();
109 return 0;
110}
111early_param("noapic", parse_noapic);
66759a01 112
da51a821 113struct irq_cfg;
0f978f45 114struct irq_pin_list;
a1420f39 115struct irq_cfg {
da51a821
YL
116 unsigned int irq;
117 struct irq_cfg *next;
0f978f45 118 struct irq_pin_list *irq_2_pin;
497c9a19
YL
119 cpumask_t domain;
120 cpumask_t old_domain;
121 unsigned move_cleanup_count;
a1420f39 122 u8 vector;
497c9a19 123 u8 move_in_progress : 1;
a1420f39
YL
124};
125
126
127/* irq_cfg is indexed by the sum of all RTEs in all I/O APICs. */
128static struct irq_cfg irq_cfg_legacy[] __initdata = {
497c9a19
YL
129 [0] = { .irq = 0, .domain = CPU_MASK_ALL, .vector = IRQ0_VECTOR, },
130 [1] = { .irq = 1, .domain = CPU_MASK_ALL, .vector = IRQ1_VECTOR, },
131 [2] = { .irq = 2, .domain = CPU_MASK_ALL, .vector = IRQ2_VECTOR, },
132 [3] = { .irq = 3, .domain = CPU_MASK_ALL, .vector = IRQ3_VECTOR, },
133 [4] = { .irq = 4, .domain = CPU_MASK_ALL, .vector = IRQ4_VECTOR, },
134 [5] = { .irq = 5, .domain = CPU_MASK_ALL, .vector = IRQ5_VECTOR, },
135 [6] = { .irq = 6, .domain = CPU_MASK_ALL, .vector = IRQ6_VECTOR, },
136 [7] = { .irq = 7, .domain = CPU_MASK_ALL, .vector = IRQ7_VECTOR, },
137 [8] = { .irq = 8, .domain = CPU_MASK_ALL, .vector = IRQ8_VECTOR, },
138 [9] = { .irq = 9, .domain = CPU_MASK_ALL, .vector = IRQ9_VECTOR, },
139 [10] = { .irq = 10, .domain = CPU_MASK_ALL, .vector = IRQ10_VECTOR, },
140 [11] = { .irq = 11, .domain = CPU_MASK_ALL, .vector = IRQ11_VECTOR, },
141 [12] = { .irq = 12, .domain = CPU_MASK_ALL, .vector = IRQ12_VECTOR, },
142 [13] = { .irq = 13, .domain = CPU_MASK_ALL, .vector = IRQ13_VECTOR, },
143 [14] = { .irq = 14, .domain = CPU_MASK_ALL, .vector = IRQ14_VECTOR, },
144 [15] = { .irq = 15, .domain = CPU_MASK_ALL, .vector = IRQ15_VECTOR, },
a1420f39
YL
145};
146
da51a821
YL
147static struct irq_cfg irq_cfg_init = { .irq = -1U, };
148/* need to be biger than size of irq_cfg_legacy */
149static int nr_irq_cfg = 32;
150
151static int __init parse_nr_irq_cfg(char *arg)
152{
153 if (arg) {
154 nr_irq_cfg = simple_strtoul(arg, NULL, 0);
155 if (nr_irq_cfg < 32)
156 nr_irq_cfg = 32;
157 }
158 return 0;
159}
160
161early_param("nr_irq_cfg", parse_nr_irq_cfg);
162
163static void init_one_irq_cfg(struct irq_cfg *cfg)
164{
165 memcpy(cfg, &irq_cfg_init, sizeof(struct irq_cfg));
166}
167
168static struct irq_cfg *irq_cfgx;
169static struct irq_cfg *irq_cfgx_free;
a1420f39
YL
170static void __init init_work(void *data)
171{
da51a821
YL
172 struct dyn_array *da = data;
173 struct irq_cfg *cfg;
174 int legacy_count;
175 int i;
176
177 cfg = *da->name;
a1420f39 178
da51a821 179 memcpy(cfg, irq_cfg_legacy, sizeof(irq_cfg_legacy));
a1420f39 180
da51a821
YL
181 legacy_count = sizeof(irq_cfg_legacy)/sizeof(irq_cfg_legacy[0]);
182 for (i = legacy_count; i < *da->nr; i++)
183 init_one_irq_cfg(&cfg[i]);
a1420f39 184
da51a821
YL
185 for (i = 1; i < *da->nr; i++)
186 cfg[i-1].next = &cfg[i];
a1420f39 187
da51a821
YL
188 irq_cfgx_free = &irq_cfgx[legacy_count];
189 irq_cfgx[legacy_count - 1].next = NULL;
a1420f39
YL
190}
191
da51a821
YL
192#define for_each_irq_cfg(cfg) \
193 for (cfg = irq_cfgx; cfg; cfg = cfg->next)
194
195DEFINE_DYN_ARRAY(irq_cfgx, sizeof(struct irq_cfg), nr_irq_cfg, PAGE_SIZE, init_work);
a1420f39
YL
196
197static struct irq_cfg *irq_cfg(unsigned int irq)
198{
da51a821
YL
199 struct irq_cfg *cfg;
200
201 cfg = irq_cfgx;
202 while (cfg) {
203 if (cfg->irq == irq)
204 return cfg;
205
206 cfg = cfg->next;
207 }
208
209 return NULL;
210}
211
212static struct irq_cfg *irq_cfg_alloc(unsigned int irq)
213{
214 struct irq_cfg *cfg, *cfg_pri;
215 int i;
216 int count = 0;
217
218 cfg_pri = cfg = irq_cfgx;
219 while (cfg) {
220 if (cfg->irq == irq)
221 return cfg;
222
223 cfg_pri = cfg;
224 cfg = cfg->next;
225 count++;
226 }
227
228 if (!irq_cfgx_free) {
229 unsigned long phys;
230 unsigned long total_bytes;
231 /*
232 * we run out of pre-allocate ones, allocate more
233 */
234 printk(KERN_DEBUG "try to get more irq_cfg %d\n", nr_irq_cfg);
235
236 total_bytes = sizeof(struct irq_cfg) * nr_irq_cfg;
237 if (after_bootmem)
238 cfg = kzalloc(total_bytes, GFP_ATOMIC);
239 else
240 cfg = __alloc_bootmem_nopanic(total_bytes, PAGE_SIZE, 0);
a1420f39 241
da51a821
YL
242 if (!cfg)
243 panic("please boot with nr_irq_cfg= %d\n", count * 2);
244
245 phys = __pa(cfg);
246 printk(KERN_DEBUG "irq_irq ==> [%#lx - %#lx]\n", phys, phys + total_bytes);
247
248 for (i = 0; i < nr_irq_cfg; i++)
249 init_one_irq_cfg(&cfg[i]);
250
251 for (i = 1; i < nr_irq_cfg; i++)
252 cfg[i-1].next = &cfg[i];
253
254 irq_cfgx_free = cfg;
255 }
256
257 cfg = irq_cfgx_free;
258 irq_cfgx_free = irq_cfgx_free->next;
259 cfg->next = NULL;
260 if (cfg_pri)
261 cfg_pri->next = cfg;
262 else
263 irq_cfgx = cfg;
264 cfg->irq = irq;
265 printk(KERN_DEBUG "found new irq_cfg for irq %d\n", cfg->irq);
266
267#ifdef CONFIG_HAVE_SPARSE_IRQ_DEBUG
268 {
269 /* dump the results */
270 struct irq_cfg *cfg;
271 unsigned long phys;
272 unsigned long bytes = sizeof(struct irq_cfg);
273
274 printk(KERN_DEBUG "=========================== %d\n", irq);
275 printk(KERN_DEBUG "irq_cfg dump after get that for %d\n", irq);
276 for_each_irq_cfg(cfg) {
277 phys = __pa(cfg);
278 printk(KERN_DEBUG "irq_cfg %d ==> [%#lx - %#lx]\n", cfg->irq, phys, phys + bytes);
279 }
280 printk(KERN_DEBUG "===========================\n");
281 }
282#endif
283 return cfg;
a1420f39
YL
284}
285
1da177e4
LT
286/*
287 * This is performance-critical, we want to do it O(1)
288 *
289 * the indexing order of this array favors 1:1 mappings
290 * between pins and IRQs.
291 */
292
0f978f45
YL
293struct irq_pin_list {
294 int apic, pin;
295 struct irq_pin_list *next;
296};
297
298static struct irq_pin_list *irq_2_pin_head;
299/* fill one page ? */
300static int nr_irq_2_pin = 0x100;
301static struct irq_pin_list *irq_2_pin_ptr;
302static void __init irq_2_pin_init_work(void *data)
303{
304 struct dyn_array *da = data;
305 struct irq_pin_list *pin;
306 int i;
307
308 pin = *da->name;
309
310 for (i = 1; i < *da->nr; i++)
311 pin[i-1].next = &pin[i];
312
313 irq_2_pin_ptr = &pin[0];
314}
315DEFINE_DYN_ARRAY(irq_2_pin_head, sizeof(struct irq_pin_list), nr_irq_2_pin, PAGE_SIZE, irq_2_pin_init_work);
316
317static struct irq_pin_list *get_one_free_irq_2_pin(void)
318{
319 struct irq_pin_list *pin;
320 int i;
321
322 pin = irq_2_pin_ptr;
323
324 if (pin) {
325 irq_2_pin_ptr = pin->next;
326 pin->next = NULL;
327 return pin;
328 }
329
330 /*
331 * we run out of pre-allocate ones, allocate more
332 */
333 printk(KERN_DEBUG "try to get more irq_2_pin %d\n", nr_irq_2_pin);
334
335 if (after_bootmem)
336 pin = kzalloc(sizeof(struct irq_pin_list)*nr_irq_2_pin,
337 GFP_ATOMIC);
338 else
339 pin = __alloc_bootmem_nopanic(sizeof(struct irq_pin_list) *
340 nr_irq_2_pin, PAGE_SIZE, 0);
341
342 if (!pin)
343 panic("can not get more irq_2_pin\n");
301e6190 344
0f978f45
YL
345 for (i = 1; i < nr_irq_2_pin; i++)
346 pin[i-1].next = &pin[i];
347
348 irq_2_pin_ptr = pin->next;
349 pin->next = NULL;
350
351 return pin;
352}
1da177e4 353
130fe05d
LT
354struct io_apic {
355 unsigned int index;
356 unsigned int unused[3];
357 unsigned int data;
358};
359
360static __attribute_const__ struct io_apic __iomem *io_apic_base(int idx)
361{
362 return (void __iomem *) __fix_to_virt(FIX_IO_APIC_BASE_0 + idx)
ec2cd0a2 363 + (mp_ioapics[idx].mp_apicaddr & ~PAGE_MASK);
130fe05d
LT
364}
365
366static inline unsigned int io_apic_read(unsigned int apic, unsigned int reg)
367{
368 struct io_apic __iomem *io_apic = io_apic_base(apic);
369 writel(reg, &io_apic->index);
370 return readl(&io_apic->data);
371}
372
373static inline void io_apic_write(unsigned int apic, unsigned int reg, unsigned int value)
374{
375 struct io_apic __iomem *io_apic = io_apic_base(apic);
376 writel(reg, &io_apic->index);
377 writel(value, &io_apic->data);
378}
379
380/*
381 * Re-write a value: to be used for read-modify-write
382 * cycles where the read already set up the index register.
383 *
384 * Older SiS APIC requires we rewrite the index register
385 */
386static inline void io_apic_modify(unsigned int apic, unsigned int reg, unsigned int value)
387{
cb468984 388 volatile struct io_apic __iomem *io_apic = io_apic_base(apic);
130fe05d
LT
389 if (sis_apic_bug)
390 writel(reg, &io_apic->index);
391 writel(value, &io_apic->data);
392}
393
cf4c6a2f
AK
394union entry_union {
395 struct { u32 w1, w2; };
396 struct IO_APIC_route_entry entry;
397};
398
399static struct IO_APIC_route_entry ioapic_read_entry(int apic, int pin)
400{
401 union entry_union eu;
402 unsigned long flags;
403 spin_lock_irqsave(&ioapic_lock, flags);
404 eu.w1 = io_apic_read(apic, 0x10 + 2 * pin);
405 eu.w2 = io_apic_read(apic, 0x11 + 2 * pin);
406 spin_unlock_irqrestore(&ioapic_lock, flags);
407 return eu.entry;
408}
409
f9dadfa7
LT
410/*
411 * When we write a new IO APIC routing entry, we need to write the high
412 * word first! If the mask bit in the low word is clear, we will enable
413 * the interrupt, and we need to make sure the entry is fully populated
414 * before that happens.
415 */
d15512f4
AK
416static void
417__ioapic_write_entry(int apic, int pin, struct IO_APIC_route_entry e)
cf4c6a2f 418{
cf4c6a2f
AK
419 union entry_union eu;
420 eu.entry = e;
f9dadfa7
LT
421 io_apic_write(apic, 0x11 + 2*pin, eu.w2);
422 io_apic_write(apic, 0x10 + 2*pin, eu.w1);
d15512f4
AK
423}
424
425static void ioapic_write_entry(int apic, int pin, struct IO_APIC_route_entry e)
426{
427 unsigned long flags;
428 spin_lock_irqsave(&ioapic_lock, flags);
429 __ioapic_write_entry(apic, pin, e);
f9dadfa7
LT
430 spin_unlock_irqrestore(&ioapic_lock, flags);
431}
432
433/*
434 * When we mask an IO APIC routing entry, we need to write the low
435 * word first, in order to set the mask bit before we change the
436 * high bits!
437 */
438static void ioapic_mask_entry(int apic, int pin)
439{
440 unsigned long flags;
441 union entry_union eu = { .entry.mask = 1 };
442
cf4c6a2f
AK
443 spin_lock_irqsave(&ioapic_lock, flags);
444 io_apic_write(apic, 0x10 + 2*pin, eu.w1);
445 io_apic_write(apic, 0x11 + 2*pin, eu.w2);
446 spin_unlock_irqrestore(&ioapic_lock, flags);
447}
448
497c9a19
YL
449#ifdef CONFIG_SMP
450static void __target_IO_APIC_irq(unsigned int irq, unsigned int dest, u8 vector)
451{
452 int apic, pin;
453 struct irq_cfg *cfg;
454 struct irq_pin_list *entry;
455
456 cfg = irq_cfg(irq);
457 entry = cfg->irq_2_pin;
458 for (;;) {
459 unsigned int reg;
460
461 if (!entry)
462 break;
463
464 apic = entry->apic;
465 pin = entry->pin;
466 io_apic_write(apic, 0x11 + pin*2, dest);
467 reg = io_apic_read(apic, 0x10 + pin*2);
468 reg &= ~IO_APIC_REDIR_VECTOR_MASK;
469 reg |= vector;
470 io_apic_modify(apic, 0x10 + pin *2, reg);
471 if (!entry->next)
472 break;
473 entry = entry->next;
474 }
475}
efa2559f
YL
476
477static int assign_irq_vector(int irq, cpumask_t mask);
478
497c9a19
YL
479static void set_ioapic_affinity_irq(unsigned int irq, cpumask_t mask)
480{
481 struct irq_cfg *cfg;
482 unsigned long flags;
483 unsigned int dest;
484 cpumask_t tmp;
485
486 cfg = irq_cfg(irq);
487
488 cpus_and(tmp, mask, cpu_online_map);
489 if (cpus_empty(tmp))
490 return;
491
492 if (assign_irq_vector(irq, mask))
493 return;
494
495 cpus_and(tmp, cfg->domain, mask);
496
497 dest = cpu_mask_to_apicid(tmp);
498 /*
499 * Only the high 8 bits are valid.
500 */
501 dest = SET_APIC_LOGICAL_ID(dest);
502
503 spin_lock_irqsave(&ioapic_lock, flags);
504 __target_IO_APIC_irq(irq, dest, cfg->vector);
505 irq_to_desc(irq)->affinity = mask;
506 spin_unlock_irqrestore(&ioapic_lock, flags);
507}
508
509#endif /* CONFIG_SMP */
510
1da177e4
LT
511/*
512 * The common case is 1:1 IRQ<->pin mappings. Sometimes there are
513 * shared ISA-space IRQs, so we have to support them. We are super
514 * fast in the common case, and fast for shared ISA-space IRQs.
515 */
516static void add_pin_to_irq(unsigned int irq, int apic, int pin)
517{
0f978f45
YL
518 struct irq_cfg *cfg;
519 struct irq_pin_list *entry;
520
521 /* first time to refer irq_cfg, so with new */
522 cfg = irq_cfg_alloc(irq);
523 entry = cfg->irq_2_pin;
524 if (!entry) {
525 entry = get_one_free_irq_2_pin();
526 cfg->irq_2_pin = entry;
527 entry->apic = apic;
528 entry->pin = pin;
529 printk(KERN_DEBUG " 0 add_pin_to_irq: irq %d --> apic %d pin %d\n", irq, apic, pin);
530 return;
531 }
1da177e4 532
0f978f45
YL
533 while (entry->next) {
534 /* not again, please */
535 if (entry->apic == apic && entry->pin == pin)
536 return;
1da177e4 537
0f978f45 538 entry = entry->next;
1da177e4 539 }
0f978f45
YL
540
541 entry->next = get_one_free_irq_2_pin();
542 entry = entry->next;
1da177e4
LT
543 entry->apic = apic;
544 entry->pin = pin;
0f978f45 545 printk(KERN_DEBUG " x add_pin_to_irq: irq %d --> apic %d pin %d\n", irq, apic, pin);
1da177e4
LT
546}
547
548/*
549 * Reroute an IRQ to a different pin.
550 */
551static void __init replace_pin_at_irq(unsigned int irq,
552 int oldapic, int oldpin,
553 int newapic, int newpin)
554{
0f978f45
YL
555 struct irq_cfg *cfg = irq_cfg(irq);
556 struct irq_pin_list *entry = cfg->irq_2_pin;
557 int replaced = 0;
1da177e4 558
0f978f45 559 while (entry) {
1da177e4
LT
560 if (entry->apic == oldapic && entry->pin == oldpin) {
561 entry->apic = newapic;
562 entry->pin = newpin;
0f978f45
YL
563 replaced = 1;
564 /* every one is different, right? */
1da177e4 565 break;
0f978f45
YL
566 }
567 entry = entry->next;
1da177e4 568 }
0f978f45
YL
569
570 /* why? call replace before add? */
571 if (!replaced)
572 add_pin_to_irq(irq, newapic, newpin);
1da177e4
LT
573}
574
36062448 575static void __modify_IO_APIC_irq(unsigned int irq, unsigned long enable, unsigned long disable)
1da177e4 576{
0f978f45
YL
577 struct irq_cfg *cfg;
578 struct irq_pin_list *entry;
1da177e4
LT
579 unsigned int pin, reg;
580
0f978f45
YL
581 cfg = irq_cfg(irq);
582 entry = cfg->irq_2_pin;
1da177e4 583 for (;;) {
0f978f45 584 if (!entry)
1da177e4 585 break;
0f978f45 586 pin = entry->pin;
1da177e4
LT
587 reg = io_apic_read(entry->apic, 0x10 + pin*2);
588 reg &= ~disable;
589 reg |= enable;
590 io_apic_modify(entry->apic, 0x10 + pin*2, reg);
591 if (!entry->next)
592 break;
0f978f45 593 entry = entry->next;
1da177e4
LT
594 }
595}
596
597/* mask = 1 */
36062448 598static void __mask_IO_APIC_irq(unsigned int irq)
1da177e4 599{
46b3b4ef 600 __modify_IO_APIC_irq(irq, IO_APIC_REDIR_MASKED, 0);
1da177e4
LT
601}
602
603/* mask = 0 */
36062448 604static void __unmask_IO_APIC_irq(unsigned int irq)
1da177e4 605{
46b3b4ef 606 __modify_IO_APIC_irq(irq, 0, IO_APIC_REDIR_MASKED);
1da177e4
LT
607}
608
609/* mask = 1, trigger = 0 */
36062448 610static void __mask_and_edge_IO_APIC_irq(unsigned int irq)
1da177e4 611{
46b3b4ef
CG
612 __modify_IO_APIC_irq(irq, IO_APIC_REDIR_MASKED,
613 IO_APIC_REDIR_LEVEL_TRIGGER);
1da177e4
LT
614}
615
616/* mask = 0, trigger = 1 */
36062448 617static void __unmask_and_level_IO_APIC_irq(unsigned int irq)
1da177e4 618{
46b3b4ef
CG
619 __modify_IO_APIC_irq(irq, IO_APIC_REDIR_LEVEL_TRIGGER,
620 IO_APIC_REDIR_MASKED);
1da177e4
LT
621}
622
36062448 623static void mask_IO_APIC_irq(unsigned int irq)
1da177e4
LT
624{
625 unsigned long flags;
626
627 spin_lock_irqsave(&ioapic_lock, flags);
628 __mask_IO_APIC_irq(irq);
629 spin_unlock_irqrestore(&ioapic_lock, flags);
630}
631
36062448 632static void unmask_IO_APIC_irq(unsigned int irq)
1da177e4
LT
633{
634 unsigned long flags;
635
636 spin_lock_irqsave(&ioapic_lock, flags);
637 __unmask_IO_APIC_irq(irq);
638 spin_unlock_irqrestore(&ioapic_lock, flags);
639}
640
641static void clear_IO_APIC_pin(unsigned int apic, unsigned int pin)
642{
643 struct IO_APIC_route_entry entry;
36062448 644
1da177e4 645 /* Check delivery_mode to be sure we're not clearing an SMI pin */
cf4c6a2f 646 entry = ioapic_read_entry(apic, pin);
1da177e4
LT
647 if (entry.delivery_mode == dest_SMI)
648 return;
649
650 /*
651 * Disable it in the IO-APIC irq-routing table:
652 */
f9dadfa7 653 ioapic_mask_entry(apic, pin);
1da177e4
LT
654}
655
36062448 656static void clear_IO_APIC(void)
1da177e4
LT
657{
658 int apic, pin;
659
660 for (apic = 0; apic < nr_ioapics; apic++)
661 for (pin = 0; pin < nr_ioapic_registers[apic]; pin++)
662 clear_IO_APIC_pin(apic, pin);
663}
664
1da177e4 665#ifndef CONFIG_SMP
75604d7f 666void send_IPI_self(int vector)
1da177e4
LT
667{
668 unsigned int cfg;
669
670 /*
671 * Wait for idle.
672 */
673 apic_wait_icr_idle();
674 cfg = APIC_DM_FIXED | APIC_DEST_SELF | vector | APIC_DEST_LOGICAL;
675 /*
676 * Send the IPI. The write to APIC_ICR fires this off.
677 */
593f4a78 678 apic_write(APIC_ICR, cfg);
1da177e4
LT
679}
680#endif /* !CONFIG_SMP */
681
682
683/*
684 * support for broken MP BIOSs, enables hand-redirection of PIRQ0-7 to
685 * specific CPU-side IRQs.
686 */
687
688#define MAX_PIRQS 8
689static int pirq_entries [MAX_PIRQS];
690static int pirqs_enabled;
1da177e4 691
1da177e4
LT
692static int __init ioapic_pirq_setup(char *str)
693{
694 int i, max;
695 int ints[MAX_PIRQS+1];
696
697 get_options(str, ARRAY_SIZE(ints), ints);
698
699 for (i = 0; i < MAX_PIRQS; i++)
700 pirq_entries[i] = -1;
701
702 pirqs_enabled = 1;
703 apic_printk(APIC_VERBOSE, KERN_INFO
704 "PIRQ redirection, working around broken MP-BIOS.\n");
705 max = MAX_PIRQS;
706 if (ints[0] < MAX_PIRQS)
707 max = ints[0];
708
709 for (i = 0; i < max; i++) {
710 apic_printk(APIC_VERBOSE, KERN_DEBUG
711 "... PIRQ%d -> IRQ %d\n", i, ints[i+1]);
712 /*
713 * PIRQs are mapped upside down, usually.
714 */
715 pirq_entries[MAX_PIRQS-i-1] = ints[i+1];
716 }
717 return 1;
718}
719
720__setup("pirq=", ioapic_pirq_setup);
721
722/*
723 * Find the IRQ entry number of a certain pin.
724 */
725static int find_irq_entry(int apic, int pin, int type)
726{
727 int i;
728
729 for (i = 0; i < mp_irq_entries; i++)
2fddb6e2
AS
730 if (mp_irqs[i].mp_irqtype == type &&
731 (mp_irqs[i].mp_dstapic == mp_ioapics[apic].mp_apicid ||
732 mp_irqs[i].mp_dstapic == MP_APIC_ALL) &&
733 mp_irqs[i].mp_dstirq == pin)
1da177e4
LT
734 return i;
735
736 return -1;
737}
738
739/*
740 * Find the pin to which IRQ[irq] (ISA) is connected
741 */
fcfd636a 742static int __init find_isa_irq_pin(int irq, int type)
1da177e4
LT
743{
744 int i;
745
746 for (i = 0; i < mp_irq_entries; i++) {
2fddb6e2 747 int lbus = mp_irqs[i].mp_srcbus;
1da177e4 748
d27e2b8e 749 if (test_bit(lbus, mp_bus_not_pci) &&
2fddb6e2
AS
750 (mp_irqs[i].mp_irqtype == type) &&
751 (mp_irqs[i].mp_srcbusirq == irq))
1da177e4 752
2fddb6e2 753 return mp_irqs[i].mp_dstirq;
1da177e4
LT
754 }
755 return -1;
756}
757
fcfd636a
EB
758static int __init find_isa_irq_apic(int irq, int type)
759{
760 int i;
761
762 for (i = 0; i < mp_irq_entries; i++) {
2fddb6e2 763 int lbus = mp_irqs[i].mp_srcbus;
fcfd636a 764
73b2961b 765 if (test_bit(lbus, mp_bus_not_pci) &&
2fddb6e2
AS
766 (mp_irqs[i].mp_irqtype == type) &&
767 (mp_irqs[i].mp_srcbusirq == irq))
fcfd636a
EB
768 break;
769 }
770 if (i < mp_irq_entries) {
771 int apic;
36062448 772 for (apic = 0; apic < nr_ioapics; apic++) {
2fddb6e2 773 if (mp_ioapics[apic].mp_apicid == mp_irqs[i].mp_dstapic)
fcfd636a
EB
774 return apic;
775 }
776 }
777
778 return -1;
779}
780
1da177e4
LT
781/*
782 * Find a specific PCI IRQ entry.
783 * Not an __init, possibly needed by modules
784 */
785static int pin_2_irq(int idx, int apic, int pin);
786
787int IO_APIC_get_PCI_irq_vector(int bus, int slot, int pin)
788{
789 int apic, i, best_guess = -1;
790
791 apic_printk(APIC_DEBUG, "querying PCI -> IRQ mapping bus:%d, "
792 "slot:%d, pin:%d.\n", bus, slot, pin);
ce6444d3 793 if (test_bit(bus, mp_bus_not_pci)) {
1da177e4
LT
794 printk(KERN_WARNING "PCI BIOS passed nonexistent PCI bus %d!\n", bus);
795 return -1;
796 }
797 for (i = 0; i < mp_irq_entries; i++) {
2fddb6e2 798 int lbus = mp_irqs[i].mp_srcbus;
1da177e4
LT
799
800 for (apic = 0; apic < nr_ioapics; apic++)
2fddb6e2
AS
801 if (mp_ioapics[apic].mp_apicid == mp_irqs[i].mp_dstapic ||
802 mp_irqs[i].mp_dstapic == MP_APIC_ALL)
1da177e4
LT
803 break;
804
47cab822 805 if (!test_bit(lbus, mp_bus_not_pci) &&
2fddb6e2 806 !mp_irqs[i].mp_irqtype &&
1da177e4 807 (bus == lbus) &&
2fddb6e2 808 (slot == ((mp_irqs[i].mp_srcbusirq >> 2) & 0x1f))) {
3de352bb 809 int irq = pin_2_irq(i, apic, mp_irqs[i].mp_dstirq);
1da177e4
LT
810
811 if (!(apic || IO_APIC_IRQ(irq)))
812 continue;
813
2fddb6e2 814 if (pin == (mp_irqs[i].mp_srcbusirq & 3))
1da177e4
LT
815 return irq;
816 /*
817 * Use the first all-but-pin matching entry as a
818 * best-guess fuzzy result for broken mptables.
819 */
820 if (best_guess < 0)
821 best_guess = irq;
822 }
823 }
824 return best_guess;
825}
129f6946 826EXPORT_SYMBOL(IO_APIC_get_PCI_irq_vector);
1da177e4 827
c0a282c2 828#if defined(CONFIG_EISA) || defined(CONFIG_MCA)
1da177e4
LT
829/*
830 * EISA Edge/Level control register, ELCR
831 */
832static int EISA_ELCR(unsigned int irq)
833{
834 if (irq < 16) {
835 unsigned int port = 0x4d0 + (irq >> 3);
836 return (inb(port) >> (irq & 7)) & 1;
837 }
838 apic_printk(APIC_VERBOSE, KERN_INFO
839 "Broken MPtable reports ISA irq %d\n", irq);
840 return 0;
841}
c0a282c2 842#endif
1da177e4 843
6728801d
AS
844/* ISA interrupts are always polarity zero edge triggered,
845 * when listed as conforming in the MP table. */
846
847#define default_ISA_trigger(idx) (0)
848#define default_ISA_polarity(idx) (0)
849
1da177e4
LT
850/* EISA interrupts are always polarity zero and can be edge or level
851 * trigger depending on the ELCR value. If an interrupt is listed as
852 * EISA conforming in the MP table, that means its trigger type must
853 * be read in from the ELCR */
854
2fddb6e2 855#define default_EISA_trigger(idx) (EISA_ELCR(mp_irqs[idx].mp_srcbusirq))
6728801d 856#define default_EISA_polarity(idx) default_ISA_polarity(idx)
1da177e4
LT
857
858/* PCI interrupts are always polarity one level triggered,
859 * when listed as conforming in the MP table. */
860
861#define default_PCI_trigger(idx) (1)
862#define default_PCI_polarity(idx) (1)
863
864/* MCA interrupts are always polarity zero level triggered,
865 * when listed as conforming in the MP table. */
866
867#define default_MCA_trigger(idx) (1)
6728801d 868#define default_MCA_polarity(idx) default_ISA_polarity(idx)
1da177e4 869
61fd47e0 870static int MPBIOS_polarity(int idx)
1da177e4 871{
2fddb6e2 872 int bus = mp_irqs[idx].mp_srcbus;
1da177e4
LT
873 int polarity;
874
875 /*
876 * Determine IRQ line polarity (high active or low active):
877 */
3de352bb 878 switch (mp_irqs[idx].mp_irqflag & 3) {
36062448 879 case 0: /* conforms, ie. bus-type dependent polarity */
1da177e4 880 {
36062448
PC
881 polarity = test_bit(bus, mp_bus_not_pci)?
882 default_ISA_polarity(idx):
883 default_PCI_polarity(idx);
884 break;
885 }
886 case 1: /* high active */
887 {
888 polarity = 0;
889 break;
890 }
891 case 2: /* reserved */
892 {
893 printk(KERN_WARNING "broken BIOS!!\n");
894 polarity = 1;
895 break;
896 }
897 case 3: /* low active */
898 {
899 polarity = 1;
900 break;
901 }
902 default: /* invalid */
903 {
904 printk(KERN_WARNING "broken BIOS!!\n");
905 polarity = 1;
906 break;
907 }
1da177e4
LT
908 }
909 return polarity;
910}
911
912static int MPBIOS_trigger(int idx)
913{
2fddb6e2 914 int bus = mp_irqs[idx].mp_srcbus;
1da177e4
LT
915 int trigger;
916
917 /*
918 * Determine IRQ trigger mode (edge or level sensitive):
919 */
3de352bb 920 switch ((mp_irqs[idx].mp_irqflag>>2) & 3) {
36062448 921 case 0: /* conforms, ie. bus-type dependent */
1da177e4 922 {
36062448
PC
923 trigger = test_bit(bus, mp_bus_not_pci)?
924 default_ISA_trigger(idx):
925 default_PCI_trigger(idx);
c0a282c2 926#if defined(CONFIG_EISA) || defined(CONFIG_MCA)
36062448
PC
927 switch (mp_bus_id_to_type[bus]) {
928 case MP_BUS_ISA: /* ISA pin */
929 {
930 /* set before the switch */
1da177e4
LT
931 break;
932 }
36062448 933 case MP_BUS_EISA: /* EISA pin */
1da177e4 934 {
36062448 935 trigger = default_EISA_trigger(idx);
1da177e4
LT
936 break;
937 }
36062448 938 case MP_BUS_PCI: /* PCI pin */
1da177e4 939 {
36062448 940 /* set before the switch */
1da177e4
LT
941 break;
942 }
36062448 943 case MP_BUS_MCA: /* MCA pin */
1da177e4 944 {
36062448 945 trigger = default_MCA_trigger(idx);
1da177e4
LT
946 break;
947 }
36062448 948 default:
1da177e4
LT
949 {
950 printk(KERN_WARNING "broken BIOS!!\n");
36062448 951 trigger = 1;
1da177e4
LT
952 break;
953 }
954 }
36062448
PC
955#endif
956 break;
957 }
958 case 1: /* edge */
959 {
960 trigger = 0;
961 break;
962 }
963 case 2: /* reserved */
964 {
965 printk(KERN_WARNING "broken BIOS!!\n");
966 trigger = 1;
967 break;
968 }
969 case 3: /* level */
970 {
971 trigger = 1;
972 break;
973 }
974 default: /* invalid */
975 {
976 printk(KERN_WARNING "broken BIOS!!\n");
977 trigger = 0;
978 break;
979 }
980 }
1da177e4
LT
981 return trigger;
982}
983
984static inline int irq_polarity(int idx)
985{
986 return MPBIOS_polarity(idx);
987}
988
989static inline int irq_trigger(int idx)
990{
991 return MPBIOS_trigger(idx);
992}
993
efa2559f 994int (*ioapic_renumber_irq)(int ioapic, int irq);
1da177e4
LT
995static int pin_2_irq(int idx, int apic, int pin)
996{
997 int irq, i;
2fddb6e2 998 int bus = mp_irqs[idx].mp_srcbus;
1da177e4
LT
999
1000 /*
1001 * Debugging check, we are in big trouble if this message pops up!
1002 */
2fddb6e2 1003 if (mp_irqs[idx].mp_dstirq != pin)
1da177e4
LT
1004 printk(KERN_ERR "broken BIOS or MPTABLE parser, ayiee!!\n");
1005
643befed 1006 if (test_bit(bus, mp_bus_not_pci))
2fddb6e2 1007 irq = mp_irqs[idx].mp_srcbusirq;
643befed
AS
1008 else {
1009 /*
1010 * PCI IRQs are mapped in order
1011 */
1012 i = irq = 0;
1013 while (i < apic)
1014 irq += nr_ioapic_registers[i++];
1015 irq += pin;
1da177e4 1016
643befed
AS
1017 /*
1018 * For MPS mode, so far only needed by ES7000 platform
1019 */
1020 if (ioapic_renumber_irq)
1021 irq = ioapic_renumber_irq(apic, irq);
1da177e4
LT
1022 }
1023
1024 /*
1025 * PCI IRQ command line redirection. Yes, limits are hardcoded.
1026 */
1027 if ((pin >= 16) && (pin <= 23)) {
1028 if (pirq_entries[pin-16] != -1) {
1029 if (!pirq_entries[pin-16]) {
1030 apic_printk(APIC_VERBOSE, KERN_DEBUG
1031 "disabling PIRQ%d\n", pin-16);
1032 } else {
1033 irq = pirq_entries[pin-16];
1034 apic_printk(APIC_VERBOSE, KERN_DEBUG
1035 "using PIRQ%d -> IRQ %d\n",
1036 pin-16, irq);
1037 }
1038 }
1039 }
1040 return irq;
1041}
1042
497c9a19
YL
1043void lock_vector_lock(void)
1044{
1045 /* Used to the online set of cpus does not change
1046 * during assign_irq_vector.
1047 */
1048 spin_lock(&vector_lock);
1049}
1da177e4 1050
497c9a19 1051void unlock_vector_lock(void)
1da177e4 1052{
497c9a19
YL
1053 spin_unlock(&vector_lock);
1054}
1da177e4 1055
497c9a19
YL
1056static int __assign_irq_vector(int irq, cpumask_t mask)
1057{
1058 static int current_vector = FIRST_DEVICE_VECTOR, current_offset = 0;
1059 unsigned int old_vector;
1060 int cpu;
1061 struct irq_cfg *cfg;
ace80ab7 1062
497c9a19 1063 cfg = irq_cfg(irq);
8339f000 1064
497c9a19
YL
1065 /* Only try and allocate irqs on cpus that are present */
1066 cpus_and(mask, mask, cpu_online_map);
ace80ab7 1067
497c9a19
YL
1068 if ((cfg->move_in_progress) || cfg->move_cleanup_count)
1069 return -EBUSY;
0a1ad60d 1070
497c9a19
YL
1071 old_vector = cfg->vector;
1072 if (old_vector) {
1073 cpumask_t tmp;
1074 cpus_and(tmp, cfg->domain, mask);
1075 if (!cpus_empty(tmp))
1076 return 0;
1077 }
1078
1079 for_each_cpu_mask_nr(cpu, mask) {
1080 cpumask_t domain, new_mask;
1081 int new_cpu;
1082 int vector, offset;
1083
1084 domain = vector_allocation_domain(cpu);
1085 cpus_and(new_mask, domain, cpu_online_map);
1086
1087 vector = current_vector;
1088 offset = current_offset;
1089next:
1090 vector += 8;
1091 if (vector >= first_system_vector) {
1092 /* If we run out of vectors on large boxen, must share them. */
1093 offset = (offset + 1) % 8;
1094 vector = FIRST_DEVICE_VECTOR + offset;
1095 }
1096 if (unlikely(current_vector == vector))
1097 continue;
1098 if (vector == SYSCALL_VECTOR)
1099 goto next;
1100
1101 for_each_cpu_mask_nr(new_cpu, new_mask)
1102 if (per_cpu(vector_irq, new_cpu)[vector] != -1)
1103 goto next;
1104 /* Found one! */
1105 current_vector = vector;
1106 current_offset = offset;
1107 if (old_vector) {
1108 cfg->move_in_progress = 1;
1109 cfg->old_domain = cfg->domain;
1110 }
7a959cff
YL
1111 printk(KERN_DEBUG "assign_irq_vector: irq %d vector %#x cpu ", irq, vector);
1112 for_each_cpu_mask_nr(new_cpu, new_mask) {
1113 per_cpu(vector_irq, new_cpu)[vector] = irq;
1114 printk(KERN_CONT " %d ", new_cpu);
1115 }
1116 printk(KERN_CONT "\n");
497c9a19
YL
1117 cfg->vector = vector;
1118 cfg->domain = domain;
1119 return 0;
1120 }
1121 return -ENOSPC;
1122}
1123
1124static int assign_irq_vector(int irq, cpumask_t mask)
1125{
1126 int err;
ace80ab7 1127 unsigned long flags;
ace80ab7
EB
1128
1129 spin_lock_irqsave(&vector_lock, flags);
497c9a19 1130 err = __assign_irq_vector(irq, mask);
26a3c49c 1131 spin_unlock_irqrestore(&vector_lock, flags);
1da177e4 1132
497c9a19
YL
1133 return err;
1134}
1135
1136static void __clear_irq_vector(int irq)
1137{
1138 struct irq_cfg *cfg;
1139 cpumask_t mask;
1140 int cpu, vector;
1141
1142 cfg = irq_cfg(irq);
1143 BUG_ON(!cfg->vector);
1144
1145 vector = cfg->vector;
1146 cpus_and(mask, cfg->domain, cpu_online_map);
1147 for_each_cpu_mask_nr(cpu, mask)
1148 per_cpu(vector_irq, cpu)[vector] = -1;
1149
1150 cfg->vector = 0;
1151 cpus_clear(cfg->domain);
1152}
1153
1154void __setup_vector_irq(int cpu)
1155{
1156 /* Initialize vector_irq on a new cpu */
1157 /* This function must be called with vector_lock held */
1158 int irq, vector;
1159 struct irq_cfg *cfg;
1160
1161 /* Mark the inuse vectors */
1162 for_each_irq_cfg(cfg) {
1163 if (!cpu_isset(cpu, cfg->domain))
1164 continue;
1165 vector = cfg->vector;
1166 irq = cfg->irq;
1167 per_cpu(vector_irq, cpu)[vector] = irq;
1168 }
1169 /* Mark the free vectors */
1170 for (vector = 0; vector < NR_VECTORS; ++vector) {
1171 irq = per_cpu(vector_irq, cpu)[vector];
1172 if (irq < 0)
1173 continue;
1174
1175 cfg = irq_cfg(irq);
1176 if (!cpu_isset(cpu, cfg->domain))
1177 per_cpu(vector_irq, cpu)[vector] = -1;
1178 }
1da177e4 1179}
3fde6900 1180
f5b9ed7a 1181static struct irq_chip ioapic_chip;
1da177e4
LT
1182
1183#define IOAPIC_AUTO -1
1184#define IOAPIC_EDGE 0
1185#define IOAPIC_LEVEL 1
1186
1d025192
YL
1187static inline int IO_APIC_irq_trigger(int irq)
1188{
1189 int apic, idx, pin;
1190
1191 for (apic = 0; apic < nr_ioapics; apic++) {
1192 for (pin = 0; pin < nr_ioapic_registers[apic]; pin++) {
1193 idx = find_irq_entry(apic, pin, mp_INT);
1194 if ((idx != -1) && (irq == pin_2_irq(idx, apic, pin)))
1195 return irq_trigger(idx);
1196 }
1197 }
1198 /*
1199 * nonexistent IRQs are edge default
1200 */
1201 return 0;
1202}
1203
497c9a19 1204static void ioapic_register_intr(int irq, unsigned long trigger)
1da177e4 1205{
08678b08
YL
1206 struct irq_desc *desc;
1207
199751d7
YL
1208 /* first time to use this irq_desc */
1209 if (irq < 16)
1210 desc = irq_to_desc(irq);
1211 else
1212 desc = irq_to_desc_alloc(irq);
1213
6ebcc00e 1214 if ((trigger == IOAPIC_AUTO && IO_APIC_irq_trigger(irq)) ||
cc75b92d 1215 trigger == IOAPIC_LEVEL) {
08678b08 1216 desc->status |= IRQ_LEVEL;
a460e745
IM
1217 set_irq_chip_and_handler_name(irq, &ioapic_chip,
1218 handle_fasteoi_irq, "fasteoi");
cc75b92d 1219 } else {
08678b08 1220 desc->status &= ~IRQ_LEVEL;
a460e745
IM
1221 set_irq_chip_and_handler_name(irq, &ioapic_chip,
1222 handle_edge_irq, "edge");
cc75b92d 1223 }
1da177e4
LT
1224}
1225
497c9a19
YL
1226static int setup_ioapic_entry(int apic, int irq,
1227 struct IO_APIC_route_entry *entry,
1228 unsigned int destination, int trigger,
1229 int polarity, int vector)
1da177e4 1230{
497c9a19
YL
1231 /*
1232 * add it to the IO-APIC irq-routing table:
1233 */
1234 memset(entry,0,sizeof(*entry));
1235
1236 entry->delivery_mode = INT_DELIVERY_MODE;
1237 entry->dest_mode = INT_DEST_MODE;
d83e94ac 1238 entry->dest = destination;
497c9a19
YL
1239
1240 entry->mask = 0; /* enable IRQ */
1241 entry->trigger = trigger;
1242 entry->polarity = polarity;
1243 entry->vector = vector;
1244
1245 /* Mask level triggered irqs.
1246 * Use IRQ_DELAYED_DISABLE for edge triggered irqs.
1247 */
1248 if (trigger)
1249 entry->mask = 1;
1250
1251 return 0;
1252}
1253
1254static void setup_IO_APIC_irq(int apic, int pin, unsigned int irq,
1255 int trigger, int polarity)
1256{
1257 struct irq_cfg *cfg;
1da177e4 1258 struct IO_APIC_route_entry entry;
497c9a19
YL
1259 cpumask_t mask;
1260
1261 if (!IO_APIC_IRQ(irq))
1262 return;
1263
1264 cfg = irq_cfg(irq);
1265
1266 mask = TARGET_CPUS;
1267 if (assign_irq_vector(irq, mask))
1268 return;
1269
1270 cpus_and(mask, cfg->domain, mask);
1271
1272 apic_printk(APIC_VERBOSE,KERN_DEBUG
1273 "IOAPIC[%d]: Set routing entry (%d-%d -> 0x%x -> "
1274 "IRQ %d Mode:%i Active:%i)\n",
1275 apic, mp_ioapics[apic].mp_apicid, pin, cfg->vector,
1276 irq, trigger, polarity);
1277
1278
1279 if (setup_ioapic_entry(mp_ioapics[apic].mp_apicid, irq, &entry,
1280 cpu_mask_to_apicid(mask), trigger, polarity,
1281 cfg->vector)) {
1282 printk("Failed to setup ioapic entry for ioapic %d, pin %d\n",
1283 mp_ioapics[apic].mp_apicid, pin);
1284 __clear_irq_vector(irq);
1285 return;
1286 }
1287
1288 ioapic_register_intr(irq, trigger);
1289 if (irq < 16)
1290 disable_8259A_irq(irq);
1291
1292 ioapic_write_entry(apic, pin, entry);
1293}
1294
1295static void __init setup_IO_APIC_irqs(void)
1296{
1297 int apic, pin, idx, irq, first_notcon = 1;
1da177e4
LT
1298
1299 apic_printk(APIC_VERBOSE, KERN_DEBUG "init IO_APIC IRQs\n");
1300
1301 for (apic = 0; apic < nr_ioapics; apic++) {
1302 for (pin = 0; pin < nr_ioapic_registers[apic]; pin++) {
1303
497c9a19 1304 idx = find_irq_entry(apic,pin,mp_INT);
1da177e4
LT
1305 if (idx == -1) {
1306 if (first_notcon) {
497c9a19 1307 apic_printk(APIC_VERBOSE, KERN_DEBUG " IO-APIC (apicid-pin) %d-%d", mp_ioapics[apic].mp_apicid, pin);
1da177e4
LT
1308 first_notcon = 0;
1309 } else
497c9a19 1310 apic_printk(APIC_VERBOSE, ", %d-%d", mp_ioapics[apic].mp_apicid, pin);
1da177e4
LT
1311 continue;
1312 }
20d225b9
YL
1313 if (!first_notcon) {
1314 apic_printk(APIC_VERBOSE, " not connected.\n");
1315 first_notcon = 1;
1316 }
1317
1da177e4 1318 irq = pin_2_irq(idx, apic, pin);
1da177e4 1319
497c9a19
YL
1320 if (multi_timer_check(apic, irq))
1321 continue;
1da177e4 1322
497c9a19 1323 add_pin_to_irq(irq, apic, pin);
36062448 1324
497c9a19
YL
1325 setup_IO_APIC_irq(apic, pin, irq,
1326 irq_trigger(idx), irq_polarity(idx));
1da177e4
LT
1327 }
1328 }
1329
1330 if (!first_notcon)
1331 apic_printk(APIC_VERBOSE, " not connected.\n");
1332}
1333
1334/*
f7633ce5 1335 * Set up the timer pin, possibly with the 8259A-master behind.
1da177e4 1336 */
f7633ce5
MR
1337static void __init setup_timer_IRQ0_pin(unsigned int apic, unsigned int pin,
1338 int vector)
1da177e4
LT
1339{
1340 struct IO_APIC_route_entry entry;
1da177e4 1341
36062448 1342 memset(&entry, 0, sizeof(entry));
1da177e4
LT
1343
1344 /*
1345 * We use logical delivery to get the timer IRQ
1346 * to the first CPU.
1347 */
1348 entry.dest_mode = INT_DEST_MODE;
03be7505 1349 entry.mask = 1; /* mask IRQ now */
d83e94ac 1350 entry.dest = cpu_mask_to_apicid(TARGET_CPUS);
1da177e4
LT
1351 entry.delivery_mode = INT_DELIVERY_MODE;
1352 entry.polarity = 0;
1353 entry.trigger = 0;
1354 entry.vector = vector;
1355
1356 /*
1357 * The timer IRQ doesn't have to know that behind the
f7633ce5 1358 * scene we may have a 8259A-master in AEOI mode ...
1da177e4 1359 */
497c9a19 1360 ioapic_register_intr(0, IOAPIC_EDGE);
1da177e4
LT
1361
1362 /*
1363 * Add it to the IO-APIC irq-routing table:
1364 */
cf4c6a2f 1365 ioapic_write_entry(apic, pin, entry);
1da177e4
LT
1366}
1367
32f71aff
MR
1368
1369__apicdebuginit(void) print_IO_APIC(void)
1da177e4
LT
1370{
1371 int apic, i;
1372 union IO_APIC_reg_00 reg_00;
1373 union IO_APIC_reg_01 reg_01;
1374 union IO_APIC_reg_02 reg_02;
1375 union IO_APIC_reg_03 reg_03;
1376 unsigned long flags;
0f978f45 1377 struct irq_cfg *cfg;
1da177e4
LT
1378
1379 if (apic_verbosity == APIC_QUIET)
1380 return;
1381
36062448 1382 printk(KERN_DEBUG "number of MP IRQ sources: %d.\n", mp_irq_entries);
1da177e4
LT
1383 for (i = 0; i < nr_ioapics; i++)
1384 printk(KERN_DEBUG "number of IO-APIC #%d registers: %d.\n",
ec2cd0a2 1385 mp_ioapics[i].mp_apicid, nr_ioapic_registers[i]);
1da177e4
LT
1386
1387 /*
1388 * We are a bit conservative about what we expect. We have to
1389 * know about every hardware change ASAP.
1390 */
1391 printk(KERN_INFO "testing the IO APIC.......................\n");
1392
1393 for (apic = 0; apic < nr_ioapics; apic++) {
1394
1395 spin_lock_irqsave(&ioapic_lock, flags);
1396 reg_00.raw = io_apic_read(apic, 0);
1397 reg_01.raw = io_apic_read(apic, 1);
1398 if (reg_01.bits.version >= 0x10)
1399 reg_02.raw = io_apic_read(apic, 2);
1400 if (reg_01.bits.version >= 0x20)
1401 reg_03.raw = io_apic_read(apic, 3);
1402 spin_unlock_irqrestore(&ioapic_lock, flags);
1403
ec2cd0a2 1404 printk(KERN_DEBUG "IO APIC #%d......\n", mp_ioapics[apic].mp_apicid);
1da177e4
LT
1405 printk(KERN_DEBUG ".... register #00: %08X\n", reg_00.raw);
1406 printk(KERN_DEBUG "....... : physical APIC id: %02X\n", reg_00.bits.ID);
1407 printk(KERN_DEBUG "....... : Delivery Type: %X\n", reg_00.bits.delivery_type);
1408 printk(KERN_DEBUG "....... : LTS : %X\n", reg_00.bits.LTS);
1da177e4
LT
1409
1410 printk(KERN_DEBUG ".... register #01: %08X\n", reg_01.raw);
1411 printk(KERN_DEBUG "....... : max redirection entries: %04X\n", reg_01.bits.entries);
1da177e4
LT
1412
1413 printk(KERN_DEBUG "....... : PRQ implemented: %X\n", reg_01.bits.PRQ);
1414 printk(KERN_DEBUG "....... : IO APIC version: %04X\n", reg_01.bits.version);
1da177e4
LT
1415
1416 /*
1417 * Some Intel chipsets with IO APIC VERSION of 0x1? don't have reg_02,
1418 * but the value of reg_02 is read as the previous read register
1419 * value, so ignore it if reg_02 == reg_01.
1420 */
1421 if (reg_01.bits.version >= 0x10 && reg_02.raw != reg_01.raw) {
1422 printk(KERN_DEBUG ".... register #02: %08X\n", reg_02.raw);
1423 printk(KERN_DEBUG "....... : arbitration: %02X\n", reg_02.bits.arbitration);
1da177e4
LT
1424 }
1425
1426 /*
1427 * Some Intel chipsets with IO APIC VERSION of 0x2? don't have reg_02
1428 * or reg_03, but the value of reg_0[23] is read as the previous read
1429 * register value, so ignore it if reg_03 == reg_0[12].
1430 */
1431 if (reg_01.bits.version >= 0x20 && reg_03.raw != reg_02.raw &&
1432 reg_03.raw != reg_01.raw) {
1433 printk(KERN_DEBUG ".... register #03: %08X\n", reg_03.raw);
1434 printk(KERN_DEBUG "....... : Boot DT : %X\n", reg_03.bits.boot_DT);
1da177e4
LT
1435 }
1436
1437 printk(KERN_DEBUG ".... IRQ redirection table:\n");
1438
d83e94ac
YL
1439 printk(KERN_DEBUG " NR Dst Mask Trig IRR Pol"
1440 " Stat Dmod Deli Vect: \n");
1da177e4
LT
1441
1442 for (i = 0; i <= reg_01.bits.entries; i++) {
1443 struct IO_APIC_route_entry entry;
1444
cf4c6a2f 1445 entry = ioapic_read_entry(apic, i);
1da177e4 1446
d83e94ac 1447 printk(KERN_DEBUG " %02x %02X ", i, entry.dest);
1da177e4
LT
1448
1449 printk("%1d %1d %1d %1d %1d %1d %1d %02X\n",
1450 entry.mask,
1451 entry.trigger,
1452 entry.irr,
1453 entry.polarity,
1454 entry.delivery_status,
1455 entry.dest_mode,
1456 entry.delivery_mode,
1457 entry.vector
1458 );
1459 }
1460 }
1da177e4 1461 printk(KERN_DEBUG "IRQ to pin mappings:\n");
0f978f45
YL
1462 for_each_irq_cfg(cfg) {
1463 struct irq_pin_list *entry = cfg->irq_2_pin;
1464 if (!entry)
1da177e4 1465 continue;
ace80ab7 1466 printk(KERN_DEBUG "IRQ%d ", i);
1da177e4
LT
1467 for (;;) {
1468 printk("-> %d:%d", entry->apic, entry->pin);
1469 if (!entry->next)
1470 break;
0f978f45 1471 entry = entry->next;
1da177e4
LT
1472 }
1473 printk("\n");
1474 }
1475
1476 printk(KERN_INFO ".................................... done.\n");
1477
1478 return;
1479}
1480
32f71aff 1481__apicdebuginit(void) print_APIC_bitfield(int base)
1da177e4
LT
1482{
1483 unsigned int v;
1484 int i, j;
1485
1486 if (apic_verbosity == APIC_QUIET)
1487 return;
1488
1489 printk(KERN_DEBUG "0123456789abcdef0123456789abcdef\n" KERN_DEBUG);
1490 for (i = 0; i < 8; i++) {
1491 v = apic_read(base + i*0x10);
1492 for (j = 0; j < 32; j++) {
1493 if (v & (1<<j))
1494 printk("1");
1495 else
1496 printk("0");
1497 }
1498 printk("\n");
1499 }
1500}
1501
32f71aff 1502__apicdebuginit(void) print_local_APIC(void *dummy)
1da177e4
LT
1503{
1504 unsigned int v, ver, maxlvt;
7ab6af7a 1505 u64 icr;
1da177e4
LT
1506
1507 if (apic_verbosity == APIC_QUIET)
1508 return;
1509
1510 printk("\n" KERN_DEBUG "printing local APIC contents on CPU#%d/%d:\n",
1511 smp_processor_id(), hard_smp_processor_id());
66823114 1512 v = apic_read(APIC_ID);
05f2d12c 1513 printk(KERN_INFO "... APIC ID: %08x (%01x)\n", v,
4c9961d5 1514 GET_APIC_ID(v));
1da177e4
LT
1515 v = apic_read(APIC_LVR);
1516 printk(KERN_INFO "... APIC VERSION: %08x\n", v);
1517 ver = GET_APIC_VERSION(v);
e05d723f 1518 maxlvt = lapic_get_maxlvt();
1da177e4
LT
1519
1520 v = apic_read(APIC_TASKPRI);
1521 printk(KERN_DEBUG "... APIC TASKPRI: %08x (%02x)\n", v, v & APIC_TPRI_MASK);
1522
1523 if (APIC_INTEGRATED(ver)) { /* !82489DX */
1524 v = apic_read(APIC_ARBPRI);
1525 printk(KERN_DEBUG "... APIC ARBPRI: %08x (%02x)\n", v,
1526 v & APIC_ARBPRI_MASK);
1527 v = apic_read(APIC_PROCPRI);
1528 printk(KERN_DEBUG "... APIC PROCPRI: %08x\n", v);
1529 }
1530
1531 v = apic_read(APIC_EOI);
1532 printk(KERN_DEBUG "... APIC EOI: %08x\n", v);
1533 v = apic_read(APIC_RRR);
1534 printk(KERN_DEBUG "... APIC RRR: %08x\n", v);
1535 v = apic_read(APIC_LDR);
1536 printk(KERN_DEBUG "... APIC LDR: %08x\n", v);
1537 v = apic_read(APIC_DFR);
1538 printk(KERN_DEBUG "... APIC DFR: %08x\n", v);
1539 v = apic_read(APIC_SPIV);
1540 printk(KERN_DEBUG "... APIC SPIV: %08x\n", v);
1541
1542 printk(KERN_DEBUG "... APIC ISR field:\n");
1543 print_APIC_bitfield(APIC_ISR);
1544 printk(KERN_DEBUG "... APIC TMR field:\n");
1545 print_APIC_bitfield(APIC_TMR);
1546 printk(KERN_DEBUG "... APIC IRR field:\n");
1547 print_APIC_bitfield(APIC_IRR);
1548
1549 if (APIC_INTEGRATED(ver)) { /* !82489DX */
1550 if (maxlvt > 3) /* Due to the Pentium erratum 3AP. */
1551 apic_write(APIC_ESR, 0);
1552 v = apic_read(APIC_ESR);
1553 printk(KERN_DEBUG "... APIC ESR: %08x\n", v);
1554 }
1555
7ab6af7a
HS
1556 icr = apic_icr_read();
1557 printk(KERN_DEBUG "... APIC ICR: %08x\n", icr);
1558 printk(KERN_DEBUG "... APIC ICR2: %08x\n", icr >> 32);
1da177e4
LT
1559
1560 v = apic_read(APIC_LVTT);
1561 printk(KERN_DEBUG "... APIC LVTT: %08x\n", v);
1562
1563 if (maxlvt > 3) { /* PC is LVT#4. */
1564 v = apic_read(APIC_LVTPC);
1565 printk(KERN_DEBUG "... APIC LVTPC: %08x\n", v);
1566 }
1567 v = apic_read(APIC_LVT0);
1568 printk(KERN_DEBUG "... APIC LVT0: %08x\n", v);
1569 v = apic_read(APIC_LVT1);
1570 printk(KERN_DEBUG "... APIC LVT1: %08x\n", v);
1571
1572 if (maxlvt > 2) { /* ERR is LVT#3. */
1573 v = apic_read(APIC_LVTERR);
1574 printk(KERN_DEBUG "... APIC LVTERR: %08x\n", v);
1575 }
1576
1577 v = apic_read(APIC_TMICT);
1578 printk(KERN_DEBUG "... APIC TMICT: %08x\n", v);
1579 v = apic_read(APIC_TMCCT);
1580 printk(KERN_DEBUG "... APIC TMCCT: %08x\n", v);
1581 v = apic_read(APIC_TDCR);
1582 printk(KERN_DEBUG "... APIC TDCR: %08x\n", v);
1583 printk("\n");
1584}
1585
32f71aff 1586__apicdebuginit(void) print_all_local_APICs(void)
1da177e4 1587{
15c8b6c1 1588 on_each_cpu(print_local_APIC, NULL, 1);
1da177e4
LT
1589}
1590
32f71aff 1591__apicdebuginit(void) print_PIC(void)
1da177e4 1592{
1da177e4
LT
1593 unsigned int v;
1594 unsigned long flags;
1595
1596 if (apic_verbosity == APIC_QUIET)
1597 return;
1598
1599 printk(KERN_DEBUG "\nprinting PIC contents\n");
1600
1601 spin_lock_irqsave(&i8259A_lock, flags);
1602
1603 v = inb(0xa1) << 8 | inb(0x21);
1604 printk(KERN_DEBUG "... PIC IMR: %04x\n", v);
1605
1606 v = inb(0xa0) << 8 | inb(0x20);
1607 printk(KERN_DEBUG "... PIC IRR: %04x\n", v);
1608
36062448
PC
1609 outb(0x0b, 0xa0);
1610 outb(0x0b, 0x20);
1da177e4 1611 v = inb(0xa0) << 8 | inb(0x20);
36062448
PC
1612 outb(0x0a, 0xa0);
1613 outb(0x0a, 0x20);
1da177e4
LT
1614
1615 spin_unlock_irqrestore(&i8259A_lock, flags);
1616
1617 printk(KERN_DEBUG "... PIC ISR: %04x\n", v);
1618
1619 v = inb(0x4d1) << 8 | inb(0x4d0);
1620 printk(KERN_DEBUG "... PIC ELCR: %04x\n", v);
1621}
1622
32f71aff
MR
1623__apicdebuginit(int) print_all_ICs(void)
1624{
1625 print_PIC();
1626 print_all_local_APICs();
1627 print_IO_APIC();
1628
1629 return 0;
1630}
1631
1632fs_initcall(print_all_ICs);
1633
1da177e4 1634
efa2559f
YL
1635/* Where if anywhere is the i8259 connect in external int mode */
1636static struct { int pin, apic; } ioapic_i8259 = { -1, -1 };
1637
1da177e4
LT
1638static void __init enable_IO_APIC(void)
1639{
1640 union IO_APIC_reg_01 reg_01;
fcfd636a
EB
1641 int i8259_apic, i8259_pin;
1642 int i, apic;
1da177e4
LT
1643 unsigned long flags;
1644
1da177e4
LT
1645 if (!pirqs_enabled)
1646 for (i = 0; i < MAX_PIRQS; i++)
1647 pirq_entries[i] = -1;
1648
1649 /*
1650 * The number of IO-APIC IRQ registers (== #pins):
1651 */
fcfd636a 1652 for (apic = 0; apic < nr_ioapics; apic++) {
1da177e4 1653 spin_lock_irqsave(&ioapic_lock, flags);
fcfd636a 1654 reg_01.raw = io_apic_read(apic, 1);
1da177e4 1655 spin_unlock_irqrestore(&ioapic_lock, flags);
fcfd636a
EB
1656 nr_ioapic_registers[apic] = reg_01.bits.entries+1;
1657 }
36062448 1658 for (apic = 0; apic < nr_ioapics; apic++) {
fcfd636a
EB
1659 int pin;
1660 /* See if any of the pins is in ExtINT mode */
1008fddc 1661 for (pin = 0; pin < nr_ioapic_registers[apic]; pin++) {
fcfd636a 1662 struct IO_APIC_route_entry entry;
cf4c6a2f 1663 entry = ioapic_read_entry(apic, pin);
fcfd636a
EB
1664
1665
1666 /* If the interrupt line is enabled and in ExtInt mode
1667 * I have found the pin where the i8259 is connected.
1668 */
1669 if ((entry.mask == 0) && (entry.delivery_mode == dest_ExtINT)) {
1670 ioapic_i8259.apic = apic;
1671 ioapic_i8259.pin = pin;
1672 goto found_i8259;
1673 }
1674 }
1675 }
1676 found_i8259:
1677 /* Look to see what if the MP table has reported the ExtINT */
1678 /* If we could not find the appropriate pin by looking at the ioapic
1679 * the i8259 probably is not connected the ioapic but give the
1680 * mptable a chance anyway.
1681 */
1682 i8259_pin = find_isa_irq_pin(0, mp_ExtINT);
1683 i8259_apic = find_isa_irq_apic(0, mp_ExtINT);
1684 /* Trust the MP table if nothing is setup in the hardware */
1685 if ((ioapic_i8259.pin == -1) && (i8259_pin >= 0)) {
1686 printk(KERN_WARNING "ExtINT not setup in hardware but reported by MP table\n");
1687 ioapic_i8259.pin = i8259_pin;
1688 ioapic_i8259.apic = i8259_apic;
1689 }
1690 /* Complain if the MP table and the hardware disagree */
1691 if (((ioapic_i8259.apic != i8259_apic) || (ioapic_i8259.pin != i8259_pin)) &&
1692 (i8259_pin >= 0) && (ioapic_i8259.pin >= 0))
1693 {
1694 printk(KERN_WARNING "ExtINT in hardware and MP table differ\n");
1da177e4
LT
1695 }
1696
1697 /*
1698 * Do not trust the IO-APIC being empty at bootup
1699 */
1700 clear_IO_APIC();
1701}
1702
1703/*
1704 * Not an __init, needed by the reboot code
1705 */
1706void disable_IO_APIC(void)
1707{
1708 /*
1709 * Clear the IO-APIC before rebooting:
1710 */
1711 clear_IO_APIC();
1712
650927ef 1713 /*
0b968d23 1714 * If the i8259 is routed through an IOAPIC
650927ef 1715 * Put that IOAPIC in virtual wire mode
0b968d23 1716 * so legacy interrupts can be delivered.
650927ef 1717 */
fcfd636a 1718 if (ioapic_i8259.pin != -1) {
650927ef 1719 struct IO_APIC_route_entry entry;
650927ef
EB
1720
1721 memset(&entry, 0, sizeof(entry));
1722 entry.mask = 0; /* Enabled */
1723 entry.trigger = 0; /* Edge */
1724 entry.irr = 0;
1725 entry.polarity = 0; /* High */
1726 entry.delivery_status = 0;
1727 entry.dest_mode = 0; /* Physical */
fcfd636a 1728 entry.delivery_mode = dest_ExtINT; /* ExtInt */
650927ef 1729 entry.vector = 0;
d83e94ac 1730 entry.dest = read_apic_id();
650927ef
EB
1731
1732 /*
1733 * Add it to the IO-APIC irq-routing table:
1734 */
cf4c6a2f 1735 ioapic_write_entry(ioapic_i8259.apic, ioapic_i8259.pin, entry);
650927ef 1736 }
fcfd636a 1737 disconnect_bsp_APIC(ioapic_i8259.pin != -1);
1da177e4
LT
1738}
1739
1740/*
1741 * function to set the IO-APIC physical IDs based on the
1742 * values stored in the MPC table.
1743 *
1744 * by Matt Domsch <Matt_Domsch@dell.com> Tue Dec 21 12:25:05 CST 1999
1745 */
1746
1da177e4
LT
1747static void __init setup_ioapic_ids_from_mpc(void)
1748{
1749 union IO_APIC_reg_00 reg_00;
1750 physid_mask_t phys_id_present_map;
1751 int apic;
1752 int i;
1753 unsigned char old_id;
1754 unsigned long flags;
1755
a4dbc34d 1756 if (x86_quirks->setup_ioapic_ids && x86_quirks->setup_ioapic_ids())
d49c4288 1757 return;
d49c4288 1758
ca05fea6
NP
1759 /*
1760 * Don't check I/O APIC IDs for xAPIC systems. They have
1761 * no meaning without the serial APIC bus.
1762 */
7c5c1e42
SL
1763 if (!(boot_cpu_data.x86_vendor == X86_VENDOR_INTEL)
1764 || APIC_XAPIC(apic_version[boot_cpu_physical_apicid]))
ca05fea6 1765 return;
1da177e4
LT
1766 /*
1767 * This is broken; anything with a real cpu count has to
1768 * circumvent this idiocy regardless.
1769 */
1770 phys_id_present_map = ioapic_phys_id_map(phys_cpu_present_map);
1771
1772 /*
1773 * Set the IOAPIC ID to the value stored in the MPC table.
1774 */
1775 for (apic = 0; apic < nr_ioapics; apic++) {
1776
1777 /* Read the register 0 value */
1778 spin_lock_irqsave(&ioapic_lock, flags);
1779 reg_00.raw = io_apic_read(apic, 0);
1780 spin_unlock_irqrestore(&ioapic_lock, flags);
36062448 1781
ec2cd0a2 1782 old_id = mp_ioapics[apic].mp_apicid;
1da177e4 1783
ec2cd0a2 1784 if (mp_ioapics[apic].mp_apicid >= get_physical_broadcast()) {
1da177e4 1785 printk(KERN_ERR "BIOS bug, IO-APIC#%d ID is %d in the MPC table!...\n",
ec2cd0a2 1786 apic, mp_ioapics[apic].mp_apicid);
1da177e4
LT
1787 printk(KERN_ERR "... fixing up to %d. (tell your hw vendor)\n",
1788 reg_00.bits.ID);
ec2cd0a2 1789 mp_ioapics[apic].mp_apicid = reg_00.bits.ID;
1da177e4
LT
1790 }
1791
1da177e4
LT
1792 /*
1793 * Sanity check, is the ID really free? Every APIC in a
1794 * system must have a unique ID or we get lots of nice
1795 * 'stuck on smp_invalidate_needed IPI wait' messages.
1796 */
1797 if (check_apicid_used(phys_id_present_map,
ec2cd0a2 1798 mp_ioapics[apic].mp_apicid)) {
1da177e4 1799 printk(KERN_ERR "BIOS bug, IO-APIC#%d ID %d is already used!...\n",
ec2cd0a2 1800 apic, mp_ioapics[apic].mp_apicid);
1da177e4
LT
1801 for (i = 0; i < get_physical_broadcast(); i++)
1802 if (!physid_isset(i, phys_id_present_map))
1803 break;
1804 if (i >= get_physical_broadcast())
1805 panic("Max APIC ID exceeded!\n");
1806 printk(KERN_ERR "... fixing up to %d. (tell your hw vendor)\n",
1807 i);
1808 physid_set(i, phys_id_present_map);
ec2cd0a2 1809 mp_ioapics[apic].mp_apicid = i;
1da177e4
LT
1810 } else {
1811 physid_mask_t tmp;
ec2cd0a2 1812 tmp = apicid_to_cpu_present(mp_ioapics[apic].mp_apicid);
1da177e4
LT
1813 apic_printk(APIC_VERBOSE, "Setting %d in the "
1814 "phys_id_present_map\n",
ec2cd0a2 1815 mp_ioapics[apic].mp_apicid);
1da177e4
LT
1816 physids_or(phys_id_present_map, phys_id_present_map, tmp);
1817 }
1818
1819
1820 /*
1821 * We need to adjust the IRQ routing table
1822 * if the ID changed.
1823 */
ec2cd0a2 1824 if (old_id != mp_ioapics[apic].mp_apicid)
1da177e4 1825 for (i = 0; i < mp_irq_entries; i++)
2fddb6e2
AS
1826 if (mp_irqs[i].mp_dstapic == old_id)
1827 mp_irqs[i].mp_dstapic
ec2cd0a2 1828 = mp_ioapics[apic].mp_apicid;
1da177e4
LT
1829
1830 /*
1831 * Read the right value from the MPC table and
1832 * write it into the ID register.
36062448 1833 */
1da177e4
LT
1834 apic_printk(APIC_VERBOSE, KERN_INFO
1835 "...changing IO-APIC physical APIC ID to %d ...",
ec2cd0a2 1836 mp_ioapics[apic].mp_apicid);
1da177e4 1837
ec2cd0a2 1838 reg_00.bits.ID = mp_ioapics[apic].mp_apicid;
1da177e4
LT
1839 spin_lock_irqsave(&ioapic_lock, flags);
1840 io_apic_write(apic, 0, reg_00.raw);
1841 spin_unlock_irqrestore(&ioapic_lock, flags);
1842
1843 /*
1844 * Sanity check
1845 */
1846 spin_lock_irqsave(&ioapic_lock, flags);
1847 reg_00.raw = io_apic_read(apic, 0);
1848 spin_unlock_irqrestore(&ioapic_lock, flags);
ec2cd0a2 1849 if (reg_00.bits.ID != mp_ioapics[apic].mp_apicid)
1da177e4
LT
1850 printk("could not set ID!\n");
1851 else
1852 apic_printk(APIC_VERBOSE, " ok.\n");
1853 }
1854}
1da177e4 1855
7ce0bcfd 1856int no_timer_check __initdata;
8542b200
ZA
1857
1858static int __init notimercheck(char *s)
1859{
1860 no_timer_check = 1;
1861 return 1;
1862}
1863__setup("no_timer_check", notimercheck);
1864
1da177e4
LT
1865/*
1866 * There is a nasty bug in some older SMP boards, their mptable lies
1867 * about the timer IRQ. We do the following to work around the situation:
1868 *
1869 * - timer IRQ defaults to IO-APIC IRQ
1870 * - if this function detects that timer IRQs are defunct, then we fall
1871 * back to ISA timer IRQs
1872 */
f0a7a5c9 1873static int __init timer_irq_works(void)
1da177e4
LT
1874{
1875 unsigned long t1 = jiffies;
4aae0702 1876 unsigned long flags;
1da177e4 1877
8542b200
ZA
1878 if (no_timer_check)
1879 return 1;
1880
4aae0702 1881 local_save_flags(flags);
1da177e4
LT
1882 local_irq_enable();
1883 /* Let ten ticks pass... */
1884 mdelay((10 * 1000) / HZ);
4aae0702 1885 local_irq_restore(flags);
1da177e4
LT
1886
1887 /*
1888 * Expect a few ticks at least, to be sure some possible
1889 * glue logic does not lock up after one or two first
1890 * ticks in a non-ExtINT mode. Also the local APIC
1891 * might have cached one ExtINT interrupt. Finally, at
1892 * least one tick may be lost due to delays.
1893 */
1d16b53e 1894 if (time_after(jiffies, t1 + 4))
1da177e4
LT
1895 return 1;
1896
1897 return 0;
1898}
1899
1900/*
1901 * In the SMP+IOAPIC case it might happen that there are an unspecified
1902 * number of pending IRQ events unhandled. These cases are very rare,
1903 * so we 'resend' these IRQs via IPIs, to the same CPU. It's much
1904 * better to do it this way as thus we do not have to be aware of
1905 * 'pending' interrupts in the IRQ path, except at this point.
1906 */
1907/*
1908 * Edge triggered needs to resend any interrupt
1909 * that was delayed but this is now handled in the device
1910 * independent code.
1911 */
1912
1913/*
f5b9ed7a
IM
1914 * Startup quirk:
1915 *
1da177e4
LT
1916 * Starting up a edge-triggered IO-APIC interrupt is
1917 * nasty - we need to make sure that we get the edge.
1918 * If it is already asserted for some reason, we need
1919 * return 1 to indicate that is was pending.
1920 *
1921 * This is not complete - we should be able to fake
1922 * an edge even if it isn't on the 8259A...
f5b9ed7a
IM
1923 *
1924 * (We do this for level-triggered IRQs too - it cannot hurt.)
1da177e4 1925 */
f5b9ed7a 1926static unsigned int startup_ioapic_irq(unsigned int irq)
1da177e4
LT
1927{
1928 int was_pending = 0;
1929 unsigned long flags;
1930
1931 spin_lock_irqsave(&ioapic_lock, flags);
1932 if (irq < 16) {
1933 disable_8259A_irq(irq);
1934 if (i8259A_irq_pending(irq))
1935 was_pending = 1;
1936 }
1937 __unmask_IO_APIC_irq(irq);
1938 spin_unlock_irqrestore(&ioapic_lock, flags);
1939
1940 return was_pending;
1941}
1942
ace80ab7 1943static int ioapic_retrigger_irq(unsigned int irq)
1da177e4 1944{
a1420f39 1945 send_IPI_self(irq_cfg(irq)->vector);
c0ad90a3
IM
1946
1947 return 1;
1948}
1949
497c9a19
YL
1950#ifdef CONFIG_SMP
1951asmlinkage void smp_irq_move_cleanup_interrupt(void)
1952{
1953 unsigned vector, me;
1954 ack_APIC_irq();
1955 irq_enter();
1956
1957 me = smp_processor_id();
1958 for (vector = FIRST_EXTERNAL_VECTOR; vector < NR_VECTORS; vector++) {
1959 unsigned int irq;
1960 struct irq_desc *desc;
1961 struct irq_cfg *cfg;
1962 irq = __get_cpu_var(vector_irq)[vector];
1963
1964 desc = irq_to_desc(irq);
1965 if (!desc)
1966 continue;
1967
1968 cfg = irq_cfg(irq);
1969 spin_lock(&desc->lock);
1970 if (!cfg->move_cleanup_count)
1971 goto unlock;
1972
1973 if ((vector == cfg->vector) && cpu_isset(me, cfg->domain))
1974 goto unlock;
1975
1976 __get_cpu_var(vector_irq)[vector] = -1;
1977 cfg->move_cleanup_count--;
1978unlock:
1979 spin_unlock(&desc->lock);
1980 }
1981
1982 irq_exit();
1983}
1984
1985static void irq_complete_move(unsigned int irq)
1986{
1987 struct irq_cfg *cfg = irq_cfg(irq);
1988 unsigned vector, me;
1989
1990 if (likely(!cfg->move_in_progress))
1991 return;
1992
1993 vector = ~get_irq_regs()->orig_ax;
1994 me = smp_processor_id();
1995 if ((vector == cfg->vector) && cpu_isset(me, cfg->domain)) {
1996 cpumask_t cleanup_mask;
1997
1998 cpus_and(cleanup_mask, cfg->old_domain, cpu_online_map);
1999 cfg->move_cleanup_count = cpus_weight(cleanup_mask);
2000 send_IPI_mask(cleanup_mask, IRQ_MOVE_CLEANUP_VECTOR);
2001 cfg->move_in_progress = 0;
2002 }
2003}
2004#else
2005static inline void irq_complete_move(unsigned int irq) {}
2006#endif
2007
1d025192
YL
2008static void ack_apic_edge(unsigned int irq)
2009{
2010 irq_complete_move(irq);
2011 move_native_irq(irq);
2012 ack_APIC_irq();
2013}
2014
efa2559f 2015atomic_t irq_mis_count;
1d025192
YL
2016static void ack_apic_level(unsigned int irq)
2017{
2018 unsigned long v;
2019 int i;
2020
2021 irq_complete_move(irq);
2022 move_native_irq(irq);
2023/*
2024 * It appears there is an erratum which affects at least version 0x11
2025 * of I/O APIC (that's the 82093AA and cores integrated into various
2026 * chipsets). Under certain conditions a level-triggered interrupt is
2027 * erroneously delivered as edge-triggered one but the respective IRR
2028 * bit gets set nevertheless. As a result the I/O unit expects an EOI
2029 * message but it will never arrive and further interrupts are blocked
2030 * from the source. The exact reason is so far unknown, but the
2031 * phenomenon was observed when two consecutive interrupt requests
2032 * from a given source get delivered to the same CPU and the source is
2033 * temporarily disabled in between.
2034 *
2035 * A workaround is to simulate an EOI message manually. We achieve it
2036 * by setting the trigger mode to edge and then to level when the edge
2037 * trigger mode gets detected in the TMR of a local APIC for a
2038 * level-triggered interrupt. We mask the source for the time of the
2039 * operation to prevent an edge-triggered interrupt escaping meanwhile.
2040 * The idea is from Manfred Spraul. --macro
2041 */
2042 i = irq_cfg(irq)->vector;
2043
2044 v = apic_read(APIC_TMR + ((i & ~0x1f) >> 1));
2045
2046 ack_APIC_irq();
2047
2048 if (!(v & (1 << (i & 0x1f)))) {
2049 atomic_inc(&irq_mis_count);
2050 spin_lock(&ioapic_lock);
2051 __mask_and_edge_IO_APIC_irq(irq);
2052 __unmask_and_level_IO_APIC_irq(irq);
2053 spin_unlock(&ioapic_lock);
2054 }
2055}
2056
f5b9ed7a
IM
2057static struct irq_chip ioapic_chip __read_mostly = {
2058 .name = "IO-APIC",
ace80ab7
EB
2059 .startup = startup_ioapic_irq,
2060 .mask = mask_IO_APIC_irq,
2061 .unmask = unmask_IO_APIC_irq,
1d025192
YL
2062 .ack = ack_apic_edge,
2063 .eoi = ack_apic_level,
54d5d424 2064#ifdef CONFIG_SMP
ace80ab7 2065 .set_affinity = set_ioapic_affinity_irq,
54d5d424 2066#endif
ace80ab7 2067 .retrigger = ioapic_retrigger_irq,
1da177e4
LT
2068};
2069
1da177e4
LT
2070
2071static inline void init_IO_APIC_traps(void)
2072{
2073 int irq;
08678b08 2074 struct irq_desc *desc;
da51a821 2075 struct irq_cfg *cfg;
1da177e4
LT
2076
2077 /*
2078 * NOTE! The local APIC isn't very good at handling
2079 * multiple interrupts at the same interrupt level.
2080 * As the interrupt level is determined by taking the
2081 * vector number and shifting that right by 4, we
2082 * want to spread these out a bit so that they don't
2083 * all fall in the same interrupt level.
2084 *
2085 * Also, we've got to be careful not to trash gate
2086 * 0x80, because int 0x80 is hm, kind of importantish. ;)
2087 */
da51a821
YL
2088 for_each_irq_cfg(cfg) {
2089 irq = cfg->irq;
2090 if (IO_APIC_IRQ(irq) && !cfg->vector) {
1da177e4
LT
2091 /*
2092 * Hmm.. We don't have an entry for this,
2093 * so default to an old-fashioned 8259
2094 * interrupt if we can..
2095 */
2096 if (irq < 16)
2097 make_8259A_irq(irq);
08678b08
YL
2098 else {
2099 desc = irq_to_desc(irq);
1da177e4 2100 /* Strange. Oh, well.. */
08678b08
YL
2101 desc->chip = &no_irq_chip;
2102 }
1da177e4
LT
2103 }
2104 }
2105}
2106
f5b9ed7a
IM
2107/*
2108 * The local APIC irq-chip implementation:
2109 */
1da177e4 2110
36062448 2111static void mask_lapic_irq(unsigned int irq)
1da177e4
LT
2112{
2113 unsigned long v;
2114
2115 v = apic_read(APIC_LVT0);
593f4a78 2116 apic_write(APIC_LVT0, v | APIC_LVT_MASKED);
1da177e4
LT
2117}
2118
36062448 2119static void unmask_lapic_irq(unsigned int irq)
1da177e4 2120{
f5b9ed7a 2121 unsigned long v;
1da177e4 2122
f5b9ed7a 2123 v = apic_read(APIC_LVT0);
593f4a78 2124 apic_write(APIC_LVT0, v & ~APIC_LVT_MASKED);
f5b9ed7a 2125}
1da177e4 2126
1d025192
YL
2127static void ack_lapic_irq(unsigned int irq)
2128{
2129 ack_APIC_irq();
2130}
2131
f5b9ed7a 2132static struct irq_chip lapic_chip __read_mostly = {
9a1c6192 2133 .name = "local-APIC",
f5b9ed7a
IM
2134 .mask = mask_lapic_irq,
2135 .unmask = unmask_lapic_irq,
c88ac1df 2136 .ack = ack_lapic_irq,
1da177e4
LT
2137};
2138
497c9a19 2139static void lapic_register_intr(int irq)
c88ac1df 2140{
08678b08
YL
2141 struct irq_desc *desc;
2142
2143 desc = irq_to_desc(irq);
2144 desc->status &= ~IRQ_LEVEL;
c88ac1df
MR
2145 set_irq_chip_and_handler_name(irq, &lapic_chip, handle_edge_irq,
2146 "edge");
c88ac1df
MR
2147}
2148
e9427101 2149static void __init setup_nmi(void)
1da177e4
LT
2150{
2151 /*
36062448 2152 * Dirty trick to enable the NMI watchdog ...
1da177e4
LT
2153 * We put the 8259A master into AEOI mode and
2154 * unmask on all local APICs LVT0 as NMI.
2155 *
2156 * The idea to use the 8259A in AEOI mode ('8259A Virtual Wire')
2157 * is from Maciej W. Rozycki - so we do not have to EOI from
2158 * the NMI handler or the timer interrupt.
36062448 2159 */
1da177e4
LT
2160 apic_printk(APIC_VERBOSE, KERN_INFO "activating NMI Watchdog ...");
2161
e9427101 2162 enable_NMI_through_LVT0();
1da177e4
LT
2163
2164 apic_printk(APIC_VERBOSE, " done.\n");
2165}
2166
2167/*
2168 * This looks a bit hackish but it's about the only one way of sending
2169 * a few INTA cycles to 8259As and any associated glue logic. ICR does
2170 * not support the ExtINT mode, unfortunately. We need to send these
2171 * cycles as some i82489DX-based boards have glue logic that keeps the
2172 * 8259A interrupt line asserted until INTA. --macro
2173 */
28acf285 2174static inline void __init unlock_ExtINT_logic(void)
1da177e4 2175{
fcfd636a 2176 int apic, pin, i;
1da177e4
LT
2177 struct IO_APIC_route_entry entry0, entry1;
2178 unsigned char save_control, save_freq_select;
1da177e4 2179
fcfd636a 2180 pin = find_isa_irq_pin(8, mp_INT);
956fb531
AB
2181 if (pin == -1) {
2182 WARN_ON_ONCE(1);
2183 return;
2184 }
fcfd636a 2185 apic = find_isa_irq_apic(8, mp_INT);
956fb531
AB
2186 if (apic == -1) {
2187 WARN_ON_ONCE(1);
1da177e4 2188 return;
956fb531 2189 }
1da177e4 2190
cf4c6a2f 2191 entry0 = ioapic_read_entry(apic, pin);
fcfd636a 2192 clear_IO_APIC_pin(apic, pin);
1da177e4
LT
2193
2194 memset(&entry1, 0, sizeof(entry1));
2195
2196 entry1.dest_mode = 0; /* physical delivery */
2197 entry1.mask = 0; /* unmask IRQ now */
d83e94ac 2198 entry1.dest = hard_smp_processor_id();
1da177e4
LT
2199 entry1.delivery_mode = dest_ExtINT;
2200 entry1.polarity = entry0.polarity;
2201 entry1.trigger = 0;
2202 entry1.vector = 0;
2203
cf4c6a2f 2204 ioapic_write_entry(apic, pin, entry1);
1da177e4
LT
2205
2206 save_control = CMOS_READ(RTC_CONTROL);
2207 save_freq_select = CMOS_READ(RTC_FREQ_SELECT);
2208 CMOS_WRITE((save_freq_select & ~RTC_RATE_SELECT) | 0x6,
2209 RTC_FREQ_SELECT);
2210 CMOS_WRITE(save_control | RTC_PIE, RTC_CONTROL);
2211
2212 i = 100;
2213 while (i-- > 0) {
2214 mdelay(10);
2215 if ((CMOS_READ(RTC_INTR_FLAGS) & RTC_PF) == RTC_PF)
2216 i -= 10;
2217 }
2218
2219 CMOS_WRITE(save_control, RTC_CONTROL);
2220 CMOS_WRITE(save_freq_select, RTC_FREQ_SELECT);
fcfd636a 2221 clear_IO_APIC_pin(apic, pin);
1da177e4 2222
cf4c6a2f 2223 ioapic_write_entry(apic, pin, entry0);
1da177e4
LT
2224}
2225
efa2559f
YL
2226static int disable_timer_pin_1 __initdata;
2227
2228static int __init parse_disable_timer_pin_1(char *arg)
2229{
2230 disable_timer_pin_1 = 1;
2231 return 0;
2232}
2233early_param("disable_timer_pin_1", parse_disable_timer_pin_1);
2234
2235int timer_through_8259 __initdata;
2236
1da177e4
LT
2237/*
2238 * This code may look a bit paranoid, but it's supposed to cooperate with
2239 * a wide range of boards and BIOS bugs. Fortunately only the timer IRQ
2240 * is so screwy. Thanks to Brian Perkins for testing/hacking this beast
2241 * fanatically on his truly buggy board.
2242 */
8542b200 2243static inline void __init check_timer(void)
1da177e4 2244{
497c9a19 2245 struct irq_cfg *cfg = irq_cfg(0);
fcfd636a 2246 int apic1, pin1, apic2, pin2;
691874fa 2247 int no_pin1 = 0;
6e908947 2248 unsigned int ver;
4aae0702
IM
2249 unsigned long flags;
2250
2251 local_irq_save(flags);
d4d25dec 2252
6e908947
IM
2253 ver = apic_read(APIC_LVR);
2254 ver = GET_APIC_VERSION(ver);
2255
1da177e4
LT
2256 /*
2257 * get/set the timer IRQ vector:
2258 */
2259 disable_8259A_irq(0);
497c9a19 2260 assign_irq_vector(0, TARGET_CPUS);
1da177e4
LT
2261
2262 /*
d11d5794
MR
2263 * As IRQ0 is to be enabled in the 8259A, the virtual
2264 * wire has to be disabled in the local APIC. Also
2265 * timer interrupts need to be acknowledged manually in
2266 * the 8259A for the i82489DX when using the NMI
2267 * watchdog as that APIC treats NMIs as level-triggered.
2268 * The AEOI mode will finish them in the 8259A
2269 * automatically.
1da177e4 2270 */
593f4a78 2271 apic_write(APIC_LVT0, APIC_LVT_MASKED | APIC_DM_EXTINT);
1da177e4 2272 init_8259A(1);
d11d5794 2273 timer_ack = (nmi_watchdog == NMI_IO_APIC && !APIC_INTEGRATED(ver));
1da177e4 2274
fcfd636a
EB
2275 pin1 = find_isa_irq_pin(0, mp_INT);
2276 apic1 = find_isa_irq_apic(0, mp_INT);
2277 pin2 = ioapic_i8259.pin;
2278 apic2 = ioapic_i8259.apic;
1da177e4 2279
49a66a0b
MR
2280 apic_printk(APIC_QUIET, KERN_INFO "..TIMER: vector=0x%02X "
2281 "apic1=%d pin1=%d apic2=%d pin2=%d\n",
497c9a19 2282 cfg->vector, apic1, pin1, apic2, pin2);
1da177e4 2283
691874fa
MR
2284 /*
2285 * Some BIOS writers are clueless and report the ExtINTA
2286 * I/O APIC input from the cascaded 8259A as the timer
2287 * interrupt input. So just in case, if only one pin
2288 * was found above, try it both directly and through the
2289 * 8259A.
2290 */
2291 if (pin1 == -1) {
2292 pin1 = pin2;
2293 apic1 = apic2;
2294 no_pin1 = 1;
2295 } else if (pin2 == -1) {
2296 pin2 = pin1;
2297 apic2 = apic1;
2298 }
2299
1da177e4
LT
2300 if (pin1 != -1) {
2301 /*
2302 * Ok, does IRQ0 through the IOAPIC work?
2303 */
691874fa
MR
2304 if (no_pin1) {
2305 add_pin_to_irq(0, apic1, pin1);
497c9a19 2306 setup_timer_IRQ0_pin(apic1, pin1, cfg->vector);
691874fa 2307 }
1da177e4
LT
2308 unmask_IO_APIC_irq(0);
2309 if (timer_irq_works()) {
2310 if (nmi_watchdog == NMI_IO_APIC) {
1da177e4
LT
2311 setup_nmi();
2312 enable_8259A_irq(0);
1da177e4 2313 }
66759a01
CE
2314 if (disable_timer_pin_1 > 0)
2315 clear_IO_APIC_pin(0, pin1);
4aae0702 2316 goto out;
1da177e4 2317 }
fcfd636a 2318 clear_IO_APIC_pin(apic1, pin1);
691874fa 2319 if (!no_pin1)
49a66a0b
MR
2320 apic_printk(APIC_QUIET, KERN_ERR "..MP-BIOS bug: "
2321 "8254 timer not connected to IO-APIC\n");
1da177e4 2322
49a66a0b
MR
2323 apic_printk(APIC_QUIET, KERN_INFO "...trying to set up timer "
2324 "(IRQ0) through the 8259A ...\n");
2325 apic_printk(APIC_QUIET, KERN_INFO
2326 "..... (found apic %d pin %d) ...\n", apic2, pin2);
1da177e4
LT
2327 /*
2328 * legacy devices should be connected to IO APIC #0
2329 */
691874fa 2330 replace_pin_at_irq(0, apic1, pin1, apic2, pin2);
497c9a19 2331 setup_timer_IRQ0_pin(apic2, pin2, cfg->vector);
24742ece 2332 unmask_IO_APIC_irq(0);
ecd29476 2333 enable_8259A_irq(0);
1da177e4 2334 if (timer_irq_works()) {
49a66a0b 2335 apic_printk(APIC_QUIET, KERN_INFO "....... works.\n");
35542c5e 2336 timer_through_8259 = 1;
1da177e4 2337 if (nmi_watchdog == NMI_IO_APIC) {
60134ebe 2338 disable_8259A_irq(0);
1da177e4 2339 setup_nmi();
60134ebe 2340 enable_8259A_irq(0);
1da177e4 2341 }
4aae0702 2342 goto out;
1da177e4
LT
2343 }
2344 /*
2345 * Cleanup, just in case ...
2346 */
ecd29476 2347 disable_8259A_irq(0);
fcfd636a 2348 clear_IO_APIC_pin(apic2, pin2);
49a66a0b 2349 apic_printk(APIC_QUIET, KERN_INFO "....... failed.\n");
1da177e4 2350 }
1da177e4
LT
2351
2352 if (nmi_watchdog == NMI_IO_APIC) {
49a66a0b
MR
2353 apic_printk(APIC_QUIET, KERN_WARNING "timer doesn't work "
2354 "through the IO-APIC - disabling NMI Watchdog!\n");
067fa0ff 2355 nmi_watchdog = NMI_NONE;
1da177e4 2356 }
d11d5794 2357 timer_ack = 0;
1da177e4 2358
49a66a0b
MR
2359 apic_printk(APIC_QUIET, KERN_INFO
2360 "...trying to set up timer as Virtual Wire IRQ...\n");
1da177e4 2361
497c9a19
YL
2362 lapic_register_intr(0);
2363 apic_write(APIC_LVT0, APIC_DM_FIXED | cfg->vector); /* Fixed mode */
1da177e4
LT
2364 enable_8259A_irq(0);
2365
2366 if (timer_irq_works()) {
49a66a0b 2367 apic_printk(APIC_QUIET, KERN_INFO "..... works.\n");
4aae0702 2368 goto out;
1da177e4 2369 }
e67465f1 2370 disable_8259A_irq(0);
497c9a19 2371 apic_write(APIC_LVT0, APIC_LVT_MASKED | APIC_DM_FIXED | cfg->vector);
49a66a0b 2372 apic_printk(APIC_QUIET, KERN_INFO "..... failed.\n");
1da177e4 2373
49a66a0b
MR
2374 apic_printk(APIC_QUIET, KERN_INFO
2375 "...trying to set up timer as ExtINT IRQ...\n");
1da177e4 2376
1da177e4
LT
2377 init_8259A(0);
2378 make_8259A_irq(0);
593f4a78 2379 apic_write(APIC_LVT0, APIC_DM_EXTINT);
1da177e4
LT
2380
2381 unlock_ExtINT_logic();
2382
2383 if (timer_irq_works()) {
49a66a0b 2384 apic_printk(APIC_QUIET, KERN_INFO "..... works.\n");
4aae0702 2385 goto out;
1da177e4 2386 }
49a66a0b 2387 apic_printk(APIC_QUIET, KERN_INFO "..... failed :(.\n");
1da177e4 2388 panic("IO-APIC + timer doesn't work! Boot with apic=debug and send a "
49a66a0b 2389 "report. Then try booting with the 'noapic' option.\n");
4aae0702
IM
2390out:
2391 local_irq_restore(flags);
1da177e4
LT
2392}
2393
2394/*
af174783
MR
2395 * Traditionally ISA IRQ2 is the cascade IRQ, and is not available
2396 * to devices. However there may be an I/O APIC pin available for
2397 * this interrupt regardless. The pin may be left unconnected, but
2398 * typically it will be reused as an ExtINT cascade interrupt for
2399 * the master 8259A. In the MPS case such a pin will normally be
2400 * reported as an ExtINT interrupt in the MP table. With ACPI
2401 * there is no provision for ExtINT interrupts, and in the absence
2402 * of an override it would be treated as an ordinary ISA I/O APIC
2403 * interrupt, that is edge-triggered and unmasked by default. We
2404 * used to do this, but it caused problems on some systems because
2405 * of the NMI watchdog and sometimes IRQ0 of the 8254 timer using
2406 * the same ExtINT cascade interrupt to drive the local APIC of the
2407 * bootstrap processor. Therefore we refrain from routing IRQ2 to
2408 * the I/O APIC in all cases now. No actual device should request
2409 * it anyway. --macro
1da177e4
LT
2410 */
2411#define PIC_IRQS (1 << PIC_CASCADE_IR)
2412
2413void __init setup_IO_APIC(void)
2414{
2415 enable_IO_APIC();
2416
af174783 2417 io_apic_irqs = ~PIC_IRQS;
1da177e4
LT
2418
2419 printk("ENABLING IO-APIC IRQs\n");
2420
2421 /*
2422 * Set up IO-APIC IRQ routing.
2423 */
2424 if (!acpi_ioapic)
2425 setup_ioapic_ids_from_mpc();
2426 sync_Arb_IDs();
2427 setup_IO_APIC_irqs();
2428 init_IO_APIC_traps();
1e4c85f9 2429 check_timer();
1da177e4
LT
2430}
2431
2432/*
2433 * Called after all the initialization is done. If we didnt find any
2434 * APIC bugs then we can allow the modify fast path
2435 */
36062448 2436
1da177e4
LT
2437static int __init io_apic_bug_finalize(void)
2438{
36062448 2439 if (sis_apic_bug == -1)
1da177e4
LT
2440 sis_apic_bug = 0;
2441 return 0;
2442}
2443
2444late_initcall(io_apic_bug_finalize);
2445
2446struct sysfs_ioapic_data {
2447 struct sys_device dev;
2448 struct IO_APIC_route_entry entry[0];
2449};
36062448 2450static struct sysfs_ioapic_data *mp_ioapic_data[MAX_IO_APICS];
1da177e4 2451
438510f6 2452static int ioapic_suspend(struct sys_device *dev, pm_message_t state)
1da177e4
LT
2453{
2454 struct IO_APIC_route_entry *entry;
2455 struct sysfs_ioapic_data *data;
1da177e4 2456 int i;
36062448 2457
1da177e4
LT
2458 data = container_of(dev, struct sysfs_ioapic_data, dev);
2459 entry = data->entry;
36062448 2460 for (i = 0; i < nr_ioapic_registers[dev->id]; i++)
cf4c6a2f 2461 entry[i] = ioapic_read_entry(dev->id, i);
1da177e4
LT
2462
2463 return 0;
2464}
2465
2466static int ioapic_resume(struct sys_device *dev)
2467{
2468 struct IO_APIC_route_entry *entry;
2469 struct sysfs_ioapic_data *data;
2470 unsigned long flags;
2471 union IO_APIC_reg_00 reg_00;
2472 int i;
36062448 2473
1da177e4
LT
2474 data = container_of(dev, struct sysfs_ioapic_data, dev);
2475 entry = data->entry;
2476
2477 spin_lock_irqsave(&ioapic_lock, flags);
2478 reg_00.raw = io_apic_read(dev->id, 0);
ec2cd0a2
AS
2479 if (reg_00.bits.ID != mp_ioapics[dev->id].mp_apicid) {
2480 reg_00.bits.ID = mp_ioapics[dev->id].mp_apicid;
1da177e4
LT
2481 io_apic_write(dev->id, 0, reg_00.raw);
2482 }
1da177e4 2483 spin_unlock_irqrestore(&ioapic_lock, flags);
36062448 2484 for (i = 0; i < nr_ioapic_registers[dev->id]; i++)
cf4c6a2f 2485 ioapic_write_entry(dev->id, i, entry[i]);
1da177e4
LT
2486
2487 return 0;
2488}
2489
2490static struct sysdev_class ioapic_sysdev_class = {
af5ca3f4 2491 .name = "ioapic",
1da177e4
LT
2492 .suspend = ioapic_suspend,
2493 .resume = ioapic_resume,
2494};
2495
2496static int __init ioapic_init_sysfs(void)
2497{
36062448 2498 struct sys_device *dev;
1da177e4
LT
2499 int i, size, error = 0;
2500
2501 error = sysdev_class_register(&ioapic_sysdev_class);
2502 if (error)
2503 return error;
2504
36062448
PC
2505 for (i = 0; i < nr_ioapics; i++) {
2506 size = sizeof(struct sys_device) + nr_ioapic_registers[i]
1da177e4 2507 * sizeof(struct IO_APIC_route_entry);
25556c16 2508 mp_ioapic_data[i] = kzalloc(size, GFP_KERNEL);
1da177e4
LT
2509 if (!mp_ioapic_data[i]) {
2510 printk(KERN_ERR "Can't suspend/resume IOAPIC %d\n", i);
2511 continue;
2512 }
1da177e4 2513 dev = &mp_ioapic_data[i]->dev;
36062448 2514 dev->id = i;
1da177e4
LT
2515 dev->cls = &ioapic_sysdev_class;
2516 error = sysdev_register(dev);
2517 if (error) {
2518 kfree(mp_ioapic_data[i]);
2519 mp_ioapic_data[i] = NULL;
2520 printk(KERN_ERR "Can't suspend/resume IOAPIC %d\n", i);
2521 continue;
2522 }
2523 }
2524
2525 return 0;
2526}
2527
2528device_initcall(ioapic_init_sysfs);
2529
3fc471ed 2530/*
95d77884 2531 * Dynamic irq allocate and deallocation
3fc471ed 2532 */
199751d7 2533unsigned int create_irq_nr(unsigned int irq_want)
3fc471ed 2534{
ace80ab7 2535 /* Allocate an unused irq */
497c9a19 2536 unsigned int irq, new;
3fc471ed 2537 unsigned long flags;
da51a821 2538 struct irq_cfg *cfg_new;
3fc471ed 2539
497c9a19 2540#ifndef CONFIG_HAVE_SPARSE_IRQ
199751d7
YL
2541 /* only can use bus/dev/fn.. when per_cpu vector is used */
2542 irq_want = nr_irqs - 1;
497c9a19 2543#endif
199751d7
YL
2544
2545 irq = 0;
ace80ab7 2546 spin_lock_irqsave(&vector_lock, flags);
199751d7 2547 for (new = (nr_irqs - 1); new > 0; new--) {
ace80ab7
EB
2548 if (platform_legacy_irq(new))
2549 continue;
da51a821
YL
2550 cfg_new = irq_cfg(new);
2551 if (cfg_new && cfg_new->vector != 0)
ace80ab7 2552 continue;
da51a821
YL
2553 if (!cfg_new)
2554 cfg_new = irq_cfg_alloc(new);
497c9a19 2555 if (__assign_irq_vector(new, TARGET_CPUS) == 0)
ace80ab7
EB
2556 irq = new;
2557 break;
2558 }
2559 spin_unlock_irqrestore(&vector_lock, flags);
3fc471ed 2560
199751d7 2561 if (irq > 0) {
3fc471ed
EB
2562 dynamic_irq_init(irq);
2563 }
2564 return irq;
2565}
2566
199751d7
YL
2567int create_irq(void)
2568{
2569 return create_irq_nr(nr_irqs - 1);
2570}
2571
3fc471ed
EB
2572void destroy_irq(unsigned int irq)
2573{
2574 unsigned long flags;
3fc471ed
EB
2575
2576 dynamic_irq_cleanup(irq);
2577
2578 spin_lock_irqsave(&vector_lock, flags);
497c9a19 2579 __clear_irq_vector(irq);
3fc471ed
EB
2580 spin_unlock_irqrestore(&vector_lock, flags);
2581}
3fc471ed 2582
2d3fcc1c 2583/*
27b46d76 2584 * MSI message composition
2d3fcc1c
EB
2585 */
2586#ifdef CONFIG_PCI_MSI
3b7d1921 2587static int msi_compose_msg(struct pci_dev *pdev, unsigned int irq, struct msi_msg *msg)
2d3fcc1c 2588{
497c9a19
YL
2589 struct irq_cfg *cfg;
2590 int err;
2d3fcc1c 2591 unsigned dest;
497c9a19 2592 cpumask_t tmp;
2d3fcc1c 2593
497c9a19
YL
2594 tmp = TARGET_CPUS;
2595 err = assign_irq_vector(irq, tmp);
2596 if (err)
2597 return err;
2d3fcc1c 2598
497c9a19
YL
2599 cfg = irq_cfg(irq);
2600 cpus_and(tmp, cfg->domain, tmp);
2601 dest = cpu_mask_to_apicid(tmp);
2602
2603 msg->address_hi = MSI_ADDR_BASE_HI;
2604 msg->address_lo =
2605 MSI_ADDR_BASE_LO |
2606 ((INT_DEST_MODE == 0) ?
2607 MSI_ADDR_DEST_MODE_PHYSICAL:
2608 MSI_ADDR_DEST_MODE_LOGICAL) |
2609 ((INT_DELIVERY_MODE != dest_LowestPrio) ?
2610 MSI_ADDR_REDIRECTION_CPU:
2611 MSI_ADDR_REDIRECTION_LOWPRI) |
2612 MSI_ADDR_DEST_ID(dest);
2613
2614 msg->data =
2615 MSI_DATA_TRIGGER_EDGE |
2616 MSI_DATA_LEVEL_ASSERT |
2617 ((INT_DELIVERY_MODE != dest_LowestPrio) ?
2618 MSI_DATA_DELIVERY_FIXED:
2619 MSI_DATA_DELIVERY_LOWPRI) |
2620 MSI_DATA_VECTOR(cfg->vector);
2621
2622 return err;
2d3fcc1c
EB
2623}
2624
3b7d1921
EB
2625#ifdef CONFIG_SMP
2626static void set_msi_irq_affinity(unsigned int irq, cpumask_t mask)
2d3fcc1c 2627{
497c9a19 2628 struct irq_cfg *cfg;
3b7d1921
EB
2629 struct msi_msg msg;
2630 unsigned int dest;
2631 cpumask_t tmp;
3b7d1921
EB
2632
2633 cpus_and(tmp, mask, cpu_online_map);
2634 if (cpus_empty(tmp))
497c9a19 2635 return;
2d3fcc1c 2636
497c9a19 2637 if (assign_irq_vector(irq, mask))
3b7d1921 2638 return;
2d3fcc1c 2639
497c9a19
YL
2640 cfg = irq_cfg(irq);
2641 cpus_and(tmp, cfg->domain, mask);
2642 dest = cpu_mask_to_apicid(tmp);
3b7d1921
EB
2643
2644 read_msi_msg(irq, &msg);
2645
2646 msg.data &= ~MSI_DATA_VECTOR_MASK;
497c9a19 2647 msg.data |= MSI_DATA_VECTOR(cfg->vector);
3b7d1921
EB
2648 msg.address_lo &= ~MSI_ADDR_DEST_ID_MASK;
2649 msg.address_lo |= MSI_ADDR_DEST_ID(dest);
2650
2651 write_msi_msg(irq, &msg);
199751d7 2652 irq_to_desc(irq)->affinity = mask;
2d3fcc1c 2653}
3b7d1921 2654#endif /* CONFIG_SMP */
2d3fcc1c 2655
3b7d1921
EB
2656/*
2657 * IRQ Chip for MSI PCI/PCI-X/PCI-Express Devices,
2658 * which implement the MSI or MSI-X Capability Structure.
2659 */
2660static struct irq_chip msi_chip = {
2661 .name = "PCI-MSI",
2662 .unmask = unmask_msi_irq,
2663 .mask = mask_msi_irq,
1d025192 2664 .ack = ack_apic_edge,
3b7d1921
EB
2665#ifdef CONFIG_SMP
2666 .set_affinity = set_msi_irq_affinity,
2667#endif
2668 .retrigger = ioapic_retrigger_irq,
2d3fcc1c
EB
2669};
2670
1d025192
YL
2671
2672static int setup_msi_irq(struct pci_dev *dev, struct msi_desc *desc, int irq)
2673{
2674 int ret;
2675 struct msi_msg msg;
2676
2677 ret = msi_compose_msg(dev, irq, &msg);
2678 if (ret < 0)
2679 return ret;
2680
2681 set_irq_msi(irq, desc);
2682 write_msi_msg(irq, &msg);
2683
2684 set_irq_chip_and_handler_name(irq, &msi_chip, handle_edge_irq, "edge");
2685
2686 return 0;
2687}
2688
199751d7
YL
2689static unsigned int build_irq_for_pci_dev(struct pci_dev *dev)
2690{
2691 unsigned int irq;
2692
2693 irq = dev->bus->number;
2694 irq <<= 8;
2695 irq |= dev->devfn;
2696 irq <<= 12;
2697
2698 return irq;
2699}
2700
f7feaca7 2701int arch_setup_msi_irq(struct pci_dev *dev, struct msi_desc *desc)
3b7d1921 2702{
f7feaca7 2703 int irq, ret;
199751d7
YL
2704
2705 unsigned int irq_want;
2706
2707 irq_want = build_irq_for_pci_dev(dev) + 0x100;
2708
2709 irq = create_irq_nr(irq_want);
2710
2711 if (irq == 0)
2712 return -1;
f7feaca7 2713
1d025192 2714 ret = setup_msi_irq(dev, desc, irq);
f7feaca7
EB
2715 if (ret < 0) {
2716 destroy_irq(irq);
3b7d1921 2717 return ret;
1d025192 2718 }
3b7d1921 2719
7fe3730d 2720 return 0;
3b7d1921
EB
2721}
2722
2723void arch_teardown_msi_irq(unsigned int irq)
2724{
f7feaca7 2725 destroy_irq(irq);
3b7d1921
EB
2726}
2727
2d3fcc1c
EB
2728#endif /* CONFIG_PCI_MSI */
2729
8b955b0d
EB
2730/*
2731 * Hypertransport interrupt support
2732 */
2733#ifdef CONFIG_HT_IRQ
2734
2735#ifdef CONFIG_SMP
2736
497c9a19 2737static void target_ht_irq(unsigned int irq, unsigned int dest, u8 vector)
8b955b0d 2738{
ec68307c
EB
2739 struct ht_irq_msg msg;
2740 fetch_ht_irq_msg(irq, &msg);
8b955b0d 2741
497c9a19 2742 msg.address_lo &= ~(HT_IRQ_LOW_VECTOR_MASK | HT_IRQ_LOW_DEST_ID_MASK);
ec68307c 2743 msg.address_hi &= ~(HT_IRQ_HIGH_DEST_ID_MASK);
8b955b0d 2744
497c9a19 2745 msg.address_lo |= HT_IRQ_LOW_VECTOR(vector) | HT_IRQ_LOW_DEST_ID(dest);
ec68307c 2746 msg.address_hi |= HT_IRQ_HIGH_DEST_ID(dest);
8b955b0d 2747
ec68307c 2748 write_ht_irq_msg(irq, &msg);
8b955b0d
EB
2749}
2750
2751static void set_ht_irq_affinity(unsigned int irq, cpumask_t mask)
2752{
497c9a19 2753 struct irq_cfg *cfg;
8b955b0d
EB
2754 unsigned int dest;
2755 cpumask_t tmp;
2756
2757 cpus_and(tmp, mask, cpu_online_map);
2758 if (cpus_empty(tmp))
497c9a19 2759 return;
8b955b0d 2760
497c9a19
YL
2761 if (assign_irq_vector(irq, mask))
2762 return;
8b955b0d 2763
497c9a19
YL
2764 cfg = irq_cfg(irq);
2765 cpus_and(tmp, cfg->domain, mask);
2766 dest = cpu_mask_to_apicid(tmp);
8b955b0d 2767
497c9a19 2768 target_ht_irq(irq, dest, cfg->vector);
199751d7 2769 irq_to_desc(irq)->affinity = mask;
8b955b0d
EB
2770}
2771#endif
2772
c37e108d 2773static struct irq_chip ht_irq_chip = {
8b955b0d
EB
2774 .name = "PCI-HT",
2775 .mask = mask_ht_irq,
2776 .unmask = unmask_ht_irq,
1d025192 2777 .ack = ack_apic_edge,
8b955b0d
EB
2778#ifdef CONFIG_SMP
2779 .set_affinity = set_ht_irq_affinity,
2780#endif
2781 .retrigger = ioapic_retrigger_irq,
2782};
2783
2784int arch_setup_ht_irq(unsigned int irq, struct pci_dev *dev)
2785{
497c9a19
YL
2786 struct irq_cfg *cfg;
2787 int err;
2788 cpumask_t tmp;
8b955b0d 2789
497c9a19
YL
2790 tmp = TARGET_CPUS;
2791 err = assign_irq_vector(irq, tmp);
2792 if ( !err) {
ec68307c 2793 struct ht_irq_msg msg;
8b955b0d 2794 unsigned dest;
8b955b0d 2795
497c9a19
YL
2796 cfg = irq_cfg(irq);
2797 cpus_and(tmp, cfg->domain, tmp);
8b955b0d
EB
2798 dest = cpu_mask_to_apicid(tmp);
2799
ec68307c 2800 msg.address_hi = HT_IRQ_HIGH_DEST_ID(dest);
8b955b0d 2801
ec68307c
EB
2802 msg.address_lo =
2803 HT_IRQ_LOW_BASE |
8b955b0d 2804 HT_IRQ_LOW_DEST_ID(dest) |
497c9a19 2805 HT_IRQ_LOW_VECTOR(cfg->vector) |
8b955b0d
EB
2806 ((INT_DEST_MODE == 0) ?
2807 HT_IRQ_LOW_DM_PHYSICAL :
2808 HT_IRQ_LOW_DM_LOGICAL) |
2809 HT_IRQ_LOW_RQEOI_EDGE |
2810 ((INT_DELIVERY_MODE != dest_LowestPrio) ?
2811 HT_IRQ_LOW_MT_FIXED :
2812 HT_IRQ_LOW_MT_ARBITRATED) |
2813 HT_IRQ_LOW_IRQ_MASKED;
2814
ec68307c 2815 write_ht_irq_msg(irq, &msg);
8b955b0d 2816
a460e745
IM
2817 set_irq_chip_and_handler_name(irq, &ht_irq_chip,
2818 handle_edge_irq, "edge");
8b955b0d 2819 }
497c9a19 2820 return err;
8b955b0d
EB
2821}
2822#endif /* CONFIG_HT_IRQ */
2823
1da177e4 2824/* --------------------------------------------------------------------------
36062448 2825 ACPI-based IOAPIC Configuration
1da177e4
LT
2826 -------------------------------------------------------------------------- */
2827
888ba6c6 2828#ifdef CONFIG_ACPI
1da177e4 2829
36062448 2830int __init io_apic_get_unique_id(int ioapic, int apic_id)
1da177e4
LT
2831{
2832 union IO_APIC_reg_00 reg_00;
2833 static physid_mask_t apic_id_map = PHYSID_MASK_NONE;
2834 physid_mask_t tmp;
2835 unsigned long flags;
2836 int i = 0;
2837
2838 /*
36062448
PC
2839 * The P4 platform supports up to 256 APIC IDs on two separate APIC
2840 * buses (one for LAPICs, one for IOAPICs), where predecessors only
1da177e4 2841 * supports up to 16 on one shared APIC bus.
36062448 2842 *
1da177e4
LT
2843 * TBD: Expand LAPIC/IOAPIC support on P4-class systems to take full
2844 * advantage of new APIC bus architecture.
2845 */
2846
2847 if (physids_empty(apic_id_map))
2848 apic_id_map = ioapic_phys_id_map(phys_cpu_present_map);
2849
2850 spin_lock_irqsave(&ioapic_lock, flags);
2851 reg_00.raw = io_apic_read(ioapic, 0);
2852 spin_unlock_irqrestore(&ioapic_lock, flags);
2853
2854 if (apic_id >= get_physical_broadcast()) {
2855 printk(KERN_WARNING "IOAPIC[%d]: Invalid apic_id %d, trying "
2856 "%d\n", ioapic, apic_id, reg_00.bits.ID);
2857 apic_id = reg_00.bits.ID;
2858 }
2859
2860 /*
36062448 2861 * Every APIC in a system must have a unique ID or we get lots of nice
1da177e4
LT
2862 * 'stuck on smp_invalidate_needed IPI wait' messages.
2863 */
2864 if (check_apicid_used(apic_id_map, apic_id)) {
2865
2866 for (i = 0; i < get_physical_broadcast(); i++) {
2867 if (!check_apicid_used(apic_id_map, i))
2868 break;
2869 }
2870
2871 if (i == get_physical_broadcast())
2872 panic("Max apic_id exceeded!\n");
2873
2874 printk(KERN_WARNING "IOAPIC[%d]: apic_id %d already used, "
2875 "trying %d\n", ioapic, apic_id, i);
2876
2877 apic_id = i;
36062448 2878 }
1da177e4
LT
2879
2880 tmp = apicid_to_cpu_present(apic_id);
2881 physids_or(apic_id_map, apic_id_map, tmp);
2882
2883 if (reg_00.bits.ID != apic_id) {
2884 reg_00.bits.ID = apic_id;
2885
2886 spin_lock_irqsave(&ioapic_lock, flags);
2887 io_apic_write(ioapic, 0, reg_00.raw);
2888 reg_00.raw = io_apic_read(ioapic, 0);
2889 spin_unlock_irqrestore(&ioapic_lock, flags);
2890
2891 /* Sanity check */
6070f9ec
AD
2892 if (reg_00.bits.ID != apic_id) {
2893 printk("IOAPIC[%d]: Unable to change apic_id!\n", ioapic);
2894 return -1;
2895 }
1da177e4
LT
2896 }
2897
2898 apic_printk(APIC_VERBOSE, KERN_INFO
2899 "IOAPIC[%d]: Assigned apic_id %d\n", ioapic, apic_id);
2900
2901 return apic_id;
2902}
2903
2904
36062448 2905int __init io_apic_get_version(int ioapic)
1da177e4
LT
2906{
2907 union IO_APIC_reg_01 reg_01;
2908 unsigned long flags;
2909
2910 spin_lock_irqsave(&ioapic_lock, flags);
2911 reg_01.raw = io_apic_read(ioapic, 1);
2912 spin_unlock_irqrestore(&ioapic_lock, flags);
2913
2914 return reg_01.bits.version;
2915}
2916
2917
36062448 2918int __init io_apic_get_redir_entries(int ioapic)
1da177e4
LT
2919{
2920 union IO_APIC_reg_01 reg_01;
2921 unsigned long flags;
2922
2923 spin_lock_irqsave(&ioapic_lock, flags);
2924 reg_01.raw = io_apic_read(ioapic, 1);
2925 spin_unlock_irqrestore(&ioapic_lock, flags);
2926
2927 return reg_01.bits.entries;
2928}
2929
2930
497c9a19 2931int io_apic_set_pci_routing(int ioapic, int pin, int irq, int triggering, int polarity)
1da177e4 2932{
1da177e4
LT
2933 if (!IO_APIC_IRQ(irq)) {
2934 printk(KERN_ERR "IOAPIC[%d]: Invalid reference to IRQ 0\n",
2935 ioapic);
2936 return -EINVAL;
2937 }
2938
1da177e4
LT
2939 /*
2940 * IRQs < 16 are already in the irq_2_pin[] map
2941 */
2942 if (irq >= 16)
2943 add_pin_to_irq(irq, ioapic, pin);
2944
497c9a19 2945 setup_IO_APIC_irq(ioapic, pin, irq, triggering, polarity);
1da177e4
LT
2946
2947 return 0;
2948}
2949
61fd47e0
SL
2950int acpi_get_override_irq(int bus_irq, int *trigger, int *polarity)
2951{
2952 int i;
2953
2954 if (skip_ioapic_setup)
2955 return -1;
2956
2957 for (i = 0; i < mp_irq_entries; i++)
2fddb6e2
AS
2958 if (mp_irqs[i].mp_irqtype == mp_INT &&
2959 mp_irqs[i].mp_srcbusirq == bus_irq)
61fd47e0
SL
2960 break;
2961 if (i >= mp_irq_entries)
2962 return -1;
2963
2964 *trigger = irq_trigger(i);
2965 *polarity = irq_polarity(i);
2966 return 0;
2967}
2968
888ba6c6 2969#endif /* CONFIG_ACPI */
1a3f239d 2970
497c9a19
YL
2971/*
2972 * This function currently is only a helper for the i386 smp boot process where
2973 * we need to reprogram the ioredtbls to cater for the cpus which have come online
2974 * so mask in all cases should simply be TARGET_CPUS
2975 */
2976#ifdef CONFIG_SMP
2977void __init setup_ioapic_dest(void)
2978{
2979 int pin, ioapic, irq, irq_entry;
2980 struct irq_cfg *cfg;
2981 struct irq_desc *desc;
2982
2983 if (skip_ioapic_setup == 1)
2984 return;
2985
2986 for (ioapic = 0; ioapic < nr_ioapics; ioapic++) {
2987 for (pin = 0; pin < nr_ioapic_registers[ioapic]; pin++) {
2988 irq_entry = find_irq_entry(ioapic, pin, mp_INT);
2989 if (irq_entry == -1)
2990 continue;
2991 irq = pin_2_irq(irq_entry, ioapic, pin);
2992
2993 /* setup_IO_APIC_irqs could fail to get vector for some device
2994 * when you have too many devices, because at that time only boot
2995 * cpu is online.
2996 */
2997 cfg = irq_cfg(irq);
2998 if (!cfg->vector)
2999 setup_IO_APIC_irq(ioapic, pin, irq,
3000 irq_trigger(irq_entry),
3001 irq_polarity(irq_entry));
3002 else {
3003 desc = irq_to_desc(irq);
3004 set_ioapic_affinity_irq(irq, TARGET_CPUS);
3005 }
3006 }
3007
3008 }
3009}
3010#endif
3011
f3294a33
YL
3012void __init ioapic_init_mappings(void)
3013{
3014 unsigned long ioapic_phys, idx = FIX_IO_APIC_BASE_0;
3015 int i;
3016
3017 for (i = 0; i < nr_ioapics; i++) {
3018 if (smp_found_config) {
3019 ioapic_phys = mp_ioapics[i].mp_apicaddr;
3020 if (!ioapic_phys) {
3021 printk(KERN_ERR
3022 "WARNING: bogus zero IO-APIC "
3023 "address found in MPTABLE, "
3024 "disabling IO/APIC support!\n");
3025 smp_found_config = 0;
3026 skip_ioapic_setup = 1;
3027 goto fake_ioapic_page;
3028 }
3029 } else {
3030fake_ioapic_page:
3031 ioapic_phys = (unsigned long)
3032 alloc_bootmem_pages(PAGE_SIZE);
3033 ioapic_phys = __pa(ioapic_phys);
3034 }
3035 set_fixmap_nocache(idx, ioapic_phys);
3036 printk(KERN_DEBUG "mapped IOAPIC to %08lx (%08lx)\n",
3037 __fix_to_virt(idx), ioapic_phys);
3038 idx++;
3039 }
3040}
3041
This page took 0.711923 seconds and 5 git commands to generate.