blob: 12e59df026dbdb838f31fa67f4fa6cfa8765e918 [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/*
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>
Linus Torvalds1da177e2005-04-16 15:20:36 -070024#include <linux/interrupt.h>
25#include <linux/init.h>
26#include <linux/delay.h>
27#include <linux/sched.h>
Yinghai Lud4057bd2008-08-19 20:50:38 -070028#include <linux/pci.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070029#include <linux/mc146818rtc.h>
30#include <linux/compiler.h>
31#include <linux/acpi.h>
Alexey Dobriyan129f6942005-06-23 00:08:33 -070032#include <linux/module.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070033#include <linux/sysdev.h>
Eric W. Biederman3b7d1922006-10-04 02:16:59 -070034#include <linux/msi.h>
Eric W. Biederman95d77882006-10-04 02:17:01 -070035#include <linux/htirq.h>
Nigel Cunningham7dfb7102006-12-06 20:34:23 -080036#include <linux/freezer.h>
Eric W. Biedermanf26d6a22007-05-02 19:27:19 +020037#include <linux/kthread.h>
Ingo Molnar54168ed2008-08-20 09:07:45 +020038#include <linux/jiffies.h> /* time_after() */
Yinghai Lud4057bd2008-08-19 20:50:38 -070039#ifdef CONFIG_ACPI
40#include <acpi/acpi_bus.h>
41#endif
42#include <linux/bootmem.h>
43#include <linux/dmar.h>
venkatesh.pallipadi@intel.com58ac1e72008-09-05 18:02:17 -070044#include <linux/hpet.h>
Ashok Raj54d5d422005-09-06 15:16:15 -070045
Yinghai Lud4057bd2008-08-19 20:50:38 -070046#include <asm/idle.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070047#include <asm/io.h>
48#include <asm/smp.h>
49#include <asm/desc.h>
Yinghai Lud4057bd2008-08-19 20:50:38 -070050#include <asm/proto.h>
51#include <asm/acpi.h>
52#include <asm/dma.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070053#include <asm/timer.h>
Ingo Molnar306e4402005-06-30 02:58:55 -070054#include <asm/i8259.h>
Don Zickus3e4ff112006-06-26 13:57:01 +020055#include <asm/nmi.h>
Eric W. Biederman2d3fcc12006-10-04 02:16:43 -070056#include <asm/msidef.h>
Eric W. Biederman8b955b02006-10-04 02:16:55 -070057#include <asm/hypertransport.h>
Yinghai Lua4dbc342008-07-25 02:14:28 -070058#include <asm/setup.h>
Yinghai Lud4057bd2008-08-19 20:50:38 -070059#include <asm/irq_remapping.h>
venkatesh.pallipadi@intel.com58ac1e72008-09-05 18:02:17 -070060#include <asm/hpet.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070061
Yinghai Lu497c9a12008-08-19 20:50:28 -070062#include <mach_ipi.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070063#include <mach_apic.h>
Andi Kleen874c4fe2006-09-26 10:52:26 +020064#include <mach_apicdef.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070065
Maciej W. Rozycki32f71af2008-07-21 00:52:49 +010066#define __apicdebuginit(type) static type __init
67
Linus Torvalds1da177e2005-04-16 15:20:36 -070068/*
Ingo Molnar54168ed2008-08-20 09:07:45 +020069 * Is the SiS APIC rmw bug present ?
70 * -1 = don't know, 0 = no, 1 = yes
Linus Torvalds1da177e2005-04-16 15:20:36 -070071 */
72int sis_apic_bug = -1;
73
Yinghai Luefa25592008-08-19 20:50:36 -070074static DEFINE_SPINLOCK(ioapic_lock);
75static DEFINE_SPINLOCK(vector_lock);
76
Yinghai Luefa25592008-08-19 20:50:36 -070077/*
Linus Torvalds1da177e2005-04-16 15:20:36 -070078 * # of IRQ routing registers
79 */
80int nr_ioapic_registers[MAX_IO_APICS];
81
Alexey Starikovskiy9f640cc2008-04-04 23:41:13 +040082/* I/O APIC entries */
Alexey Starikovskiyec2cd0a2008-05-14 19:03:10 +040083struct mp_config_ioapic mp_ioapics[MAX_IO_APICS];
Alexey Starikovskiy9f640cc2008-04-04 23:41:13 +040084int nr_ioapics;
85
Alexey Starikovskiy584f7342008-04-04 23:41:32 +040086/* MP IRQ source entries */
Alexey Starikovskiy2fddb6e282008-05-14 19:03:17 +040087struct mp_config_intsrc mp_irqs[MAX_IRQ_SOURCES];
Alexey Starikovskiy584f7342008-04-04 23:41:32 +040088
89/* # of MP IRQ source entries */
90int mp_irq_entries;
91
Alexey Starikovskiy8732fc42008-05-19 19:47:16 +040092#if defined (CONFIG_MCA) || defined (CONFIG_EISA)
93int mp_bus_id_to_type[MAX_MP_BUSSES];
94#endif
95
96DECLARE_BITMAP(mp_bus_not_pci, MAX_MP_BUSSES);
97
Yinghai Luefa25592008-08-19 20:50:36 -070098int skip_ioapic_setup;
99
Ingo Molnar54168ed2008-08-20 09:07:45 +0200100static int __init parse_noapic(char *str)
Yinghai Luefa25592008-08-19 20:50:36 -0700101{
102 /* disable IO-APIC */
103 disable_ioapic_setup();
104 return 0;
105}
106early_param("noapic", parse_noapic);
Chuck Ebbert66759a02005-09-12 18:49:25 +0200107
Yinghai Luda51a822008-08-19 20:50:25 -0700108struct irq_cfg;
Yinghai Lu0f978f42008-08-19 20:50:26 -0700109struct irq_pin_list;
Yinghai Lua1420f32008-08-19 20:50:24 -0700110struct irq_cfg {
Yinghai Luda51a822008-08-19 20:50:25 -0700111 unsigned int irq;
Yinghai Lu8f09cd22008-08-19 20:50:51 -0700112#ifdef CONFIG_HAVE_SPARSE_IRQ
Yinghai Luda51a822008-08-19 20:50:25 -0700113 struct irq_cfg *next;
Yinghai Lu8f09cd22008-08-19 20:50:51 -0700114#endif
Yinghai Lu0f978f42008-08-19 20:50:26 -0700115 struct irq_pin_list *irq_2_pin;
Yinghai Lu497c9a12008-08-19 20:50:28 -0700116 cpumask_t domain;
117 cpumask_t old_domain;
118 unsigned move_cleanup_count;
Yinghai Lua1420f32008-08-19 20:50:24 -0700119 u8 vector;
Yinghai Lu497c9a12008-08-19 20:50:28 -0700120 u8 move_in_progress : 1;
Yinghai Lua1420f32008-08-19 20:50:24 -0700121};
122
Yinghai Lua1420f32008-08-19 20:50:24 -0700123/* irq_cfg is indexed by the sum of all RTEs in all I/O APICs. */
124static struct irq_cfg irq_cfg_legacy[] __initdata = {
Yinghai Lu497c9a12008-08-19 20:50:28 -0700125 [0] = { .irq = 0, .domain = CPU_MASK_ALL, .vector = IRQ0_VECTOR, },
126 [1] = { .irq = 1, .domain = CPU_MASK_ALL, .vector = IRQ1_VECTOR, },
127 [2] = { .irq = 2, .domain = CPU_MASK_ALL, .vector = IRQ2_VECTOR, },
128 [3] = { .irq = 3, .domain = CPU_MASK_ALL, .vector = IRQ3_VECTOR, },
129 [4] = { .irq = 4, .domain = CPU_MASK_ALL, .vector = IRQ4_VECTOR, },
130 [5] = { .irq = 5, .domain = CPU_MASK_ALL, .vector = IRQ5_VECTOR, },
131 [6] = { .irq = 6, .domain = CPU_MASK_ALL, .vector = IRQ6_VECTOR, },
132 [7] = { .irq = 7, .domain = CPU_MASK_ALL, .vector = IRQ7_VECTOR, },
133 [8] = { .irq = 8, .domain = CPU_MASK_ALL, .vector = IRQ8_VECTOR, },
134 [9] = { .irq = 9, .domain = CPU_MASK_ALL, .vector = IRQ9_VECTOR, },
135 [10] = { .irq = 10, .domain = CPU_MASK_ALL, .vector = IRQ10_VECTOR, },
136 [11] = { .irq = 11, .domain = CPU_MASK_ALL, .vector = IRQ11_VECTOR, },
137 [12] = { .irq = 12, .domain = CPU_MASK_ALL, .vector = IRQ12_VECTOR, },
138 [13] = { .irq = 13, .domain = CPU_MASK_ALL, .vector = IRQ13_VECTOR, },
139 [14] = { .irq = 14, .domain = CPU_MASK_ALL, .vector = IRQ14_VECTOR, },
140 [15] = { .irq = 15, .domain = CPU_MASK_ALL, .vector = IRQ15_VECTOR, },
Yinghai Lua1420f32008-08-19 20:50:24 -0700141};
142
Yinghai Luda51a822008-08-19 20:50:25 -0700143static struct irq_cfg irq_cfg_init = { .irq = -1U, };
Yinghai Lua1420f32008-08-19 20:50:24 -0700144
Yinghai Luda51a822008-08-19 20:50:25 -0700145static void init_one_irq_cfg(struct irq_cfg *cfg)
146{
147 memcpy(cfg, &irq_cfg_init, sizeof(struct irq_cfg));
Yinghai Lua1420f32008-08-19 20:50:24 -0700148}
149
150static struct irq_cfg *irq_cfgx;
Yinghai Lue89eb432008-08-20 20:46:25 -0700151
Cyrill Gorcunovac54a6c2008-09-04 22:37:50 +0400152#ifdef CONFIG_HAVE_SPARSE_IRQ
Yinghai Lue89eb432008-08-20 20:46:25 -0700153/*
154 * Protect the irq_cfgx_free freelist:
155 */
156static DEFINE_SPINLOCK(irq_cfg_lock);
157
Yinghai Luda51a822008-08-19 20:50:25 -0700158static struct irq_cfg *irq_cfgx_free;
Yinghai Lu8f09cd22008-08-19 20:50:51 -0700159#endif
Cyrill Gorcunovac54a6c2008-09-04 22:37:50 +0400160
Yinghai Luda51a822008-08-19 20:50:25 -0700161static void __init init_work(void *data)
162{
163 struct dyn_array *da = data;
164 struct irq_cfg *cfg;
165 int legacy_count;
166 int i;
167
168 cfg = *da->name;
169
170 memcpy(cfg, irq_cfg_legacy, sizeof(irq_cfg_legacy));
171
Cyrill Gorcunov676f4a92008-09-04 22:37:49 +0400172 legacy_count = ARRAY_SIZE(irq_cfg_legacy);
Yinghai Luda51a822008-08-19 20:50:25 -0700173 for (i = legacy_count; i < *da->nr; i++)
174 init_one_irq_cfg(&cfg[i]);
175
Yinghai Lu8f09cd22008-08-19 20:50:51 -0700176#ifdef CONFIG_HAVE_SPARSE_IRQ
Yinghai Luda51a822008-08-19 20:50:25 -0700177 for (i = 1; i < *da->nr; i++)
178 cfg[i-1].next = &cfg[i];
179
180 irq_cfgx_free = &irq_cfgx[legacy_count];
181 irq_cfgx[legacy_count - 1].next = NULL;
Yinghai Lu8f09cd22008-08-19 20:50:51 -0700182#endif
Yinghai Luda51a822008-08-19 20:50:25 -0700183}
184
Yinghai Lu8f09cd22008-08-19 20:50:51 -0700185#ifdef CONFIG_HAVE_SPARSE_IRQ
186/* need to be biger than size of irq_cfg_legacy */
187static int nr_irq_cfg = 32;
188
189static int __init parse_nr_irq_cfg(char *arg)
190{
191 if (arg) {
192 nr_irq_cfg = simple_strtoul(arg, NULL, 0);
193 if (nr_irq_cfg < 32)
194 nr_irq_cfg = 32;
195 }
196 return 0;
197}
198
199early_param("nr_irq_cfg", parse_nr_irq_cfg);
200
201#define for_each_irq_cfg(irqX, cfg) \
202 for (cfg = irq_cfgx, irqX = cfg->irq; cfg; cfg = cfg->next, irqX = cfg ? cfg->irq : -1U)
203
Yinghai Luda51a822008-08-19 20:50:25 -0700204
205DEFINE_DYN_ARRAY(irq_cfgx, sizeof(struct irq_cfg), nr_irq_cfg, PAGE_SIZE, init_work);
Yinghai Lua1420f32008-08-19 20:50:24 -0700206
207static struct irq_cfg *irq_cfg(unsigned int irq)
208{
Yinghai Luda51a822008-08-19 20:50:25 -0700209 struct irq_cfg *cfg;
Yinghai Lua1420f32008-08-19 20:50:24 -0700210
Yinghai Luda51a822008-08-19 20:50:25 -0700211 cfg = irq_cfgx;
212 while (cfg) {
213 if (cfg->irq == irq)
214 return cfg;
215
216 cfg = cfg->next;
217 }
218
219 return NULL;
220}
221
222static struct irq_cfg *irq_cfg_alloc(unsigned int irq)
223{
224 struct irq_cfg *cfg, *cfg_pri;
Yinghai Lue89eb432008-08-20 20:46:25 -0700225 unsigned long flags;
Yinghai Luda51a822008-08-19 20:50:25 -0700226 int count = 0;
Yinghai Lue89eb432008-08-20 20:46:25 -0700227 int i;
Yinghai Luda51a822008-08-19 20:50:25 -0700228
229 cfg_pri = cfg = irq_cfgx;
230 while (cfg) {
231 if (cfg->irq == irq)
232 return cfg;
233
234 cfg_pri = cfg;
235 cfg = cfg->next;
236 count++;
237 }
238
Yinghai Lue89eb432008-08-20 20:46:25 -0700239 spin_lock_irqsave(&irq_cfg_lock, flags);
Yinghai Luda51a822008-08-19 20:50:25 -0700240 if (!irq_cfgx_free) {
241 unsigned long phys;
242 unsigned long total_bytes;
243 /*
244 * we run out of pre-allocate ones, allocate more
245 */
246 printk(KERN_DEBUG "try to get more irq_cfg %d\n", nr_irq_cfg);
247
248 total_bytes = sizeof(struct irq_cfg) * nr_irq_cfg;
249 if (after_bootmem)
250 cfg = kzalloc(total_bytes, GFP_ATOMIC);
251 else
252 cfg = __alloc_bootmem_nopanic(total_bytes, PAGE_SIZE, 0);
253
254 if (!cfg)
255 panic("please boot with nr_irq_cfg= %d\n", count * 2);
256
257 phys = __pa(cfg);
258 printk(KERN_DEBUG "irq_irq ==> [%#lx - %#lx]\n", phys, phys + total_bytes);
259
260 for (i = 0; i < nr_irq_cfg; i++)
261 init_one_irq_cfg(&cfg[i]);
262
263 for (i = 1; i < nr_irq_cfg; i++)
264 cfg[i-1].next = &cfg[i];
265
266 irq_cfgx_free = cfg;
267 }
268
269 cfg = irq_cfgx_free;
270 irq_cfgx_free = irq_cfgx_free->next;
271 cfg->next = NULL;
272 if (cfg_pri)
273 cfg_pri->next = cfg;
274 else
275 irq_cfgx = cfg;
276 cfg->irq = irq;
Yinghai Lue89eb432008-08-20 20:46:25 -0700277
278 spin_unlock_irqrestore(&irq_cfg_lock, flags);
279
Yinghai Luda51a822008-08-19 20:50:25 -0700280 printk(KERN_DEBUG "found new irq_cfg for irq %d\n", cfg->irq);
Yinghai Luda51a822008-08-19 20:50:25 -0700281#ifdef CONFIG_HAVE_SPARSE_IRQ_DEBUG
282 {
283 /* dump the results */
284 struct irq_cfg *cfg;
285 unsigned long phys;
286 unsigned long bytes = sizeof(struct irq_cfg);
287
288 printk(KERN_DEBUG "=========================== %d\n", irq);
289 printk(KERN_DEBUG "irq_cfg dump after get that for %d\n", irq);
290 for_each_irq_cfg(cfg) {
291 phys = __pa(cfg);
292 printk(KERN_DEBUG "irq_cfg %d ==> [%#lx - %#lx]\n", cfg->irq, phys, phys + bytes);
293 }
294 printk(KERN_DEBUG "===========================\n");
295 }
296#endif
297 return cfg;
Yinghai Lua1420f32008-08-19 20:50:24 -0700298}
Yinghai Lu8f09cd22008-08-19 20:50:51 -0700299#else
Yinghai Lua1420f32008-08-19 20:50:24 -0700300
Yinghai Lu8f09cd22008-08-19 20:50:51 -0700301#define for_each_irq_cfg(irq, cfg) \
302 for (irq = 0, cfg = &irq_cfgx[irq]; irq < nr_irqs; irq++, cfg = &irq_cfgx[irq])
303
304DEFINE_DYN_ARRAY(irq_cfgx, sizeof(struct irq_cfg), nr_irqs, PAGE_SIZE, init_work);
305
306struct irq_cfg *irq_cfg(unsigned int irq)
307{
308 if (irq < nr_irqs)
309 return &irq_cfgx[irq];
310
311 return NULL;
312}
313struct irq_cfg *irq_cfg_alloc(unsigned int irq)
314{
315 return irq_cfg(irq);
316}
317
318#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -0700319/*
320 * This is performance-critical, we want to do it O(1)
321 *
322 * the indexing order of this array favors 1:1 mappings
323 * between pins and IRQs.
324 */
325
Yinghai Lu0f978f42008-08-19 20:50:26 -0700326struct irq_pin_list {
327 int apic, pin;
328 struct irq_pin_list *next;
329};
Yinghai Lu301e6192008-08-19 20:50:02 -0700330
Yinghai Lu0f978f42008-08-19 20:50:26 -0700331static struct irq_pin_list *irq_2_pin_head;
332/* fill one page ? */
333static int nr_irq_2_pin = 0x100;
334static struct irq_pin_list *irq_2_pin_ptr;
335static void __init irq_2_pin_init_work(void *data)
336{
337 struct dyn_array *da = data;
338 struct irq_pin_list *pin;
339 int i;
340
341 pin = *da->name;
342
343 for (i = 1; i < *da->nr; i++)
344 pin[i-1].next = &pin[i];
345
346 irq_2_pin_ptr = &pin[0];
347}
348DEFINE_DYN_ARRAY(irq_2_pin_head, sizeof(struct irq_pin_list), nr_irq_2_pin, PAGE_SIZE, irq_2_pin_init_work);
349
350static struct irq_pin_list *get_one_free_irq_2_pin(void)
351{
352 struct irq_pin_list *pin;
353 int i;
354
355 pin = irq_2_pin_ptr;
356
357 if (pin) {
358 irq_2_pin_ptr = pin->next;
359 pin->next = NULL;
360 return pin;
361 }
362
363 /*
364 * we run out of pre-allocate ones, allocate more
365 */
366 printk(KERN_DEBUG "try to get more irq_2_pin %d\n", nr_irq_2_pin);
367
368 if (after_bootmem)
369 pin = kzalloc(sizeof(struct irq_pin_list)*nr_irq_2_pin,
370 GFP_ATOMIC);
371 else
372 pin = __alloc_bootmem_nopanic(sizeof(struct irq_pin_list) *
373 nr_irq_2_pin, PAGE_SIZE, 0);
374
375 if (!pin)
376 panic("can not get more irq_2_pin\n");
377
378 for (i = 1; i < nr_irq_2_pin; i++)
379 pin[i-1].next = &pin[i];
380
381 irq_2_pin_ptr = pin->next;
382 pin->next = NULL;
383
384 return pin;
385}
Linus Torvalds1da177e2005-04-16 15:20:36 -0700386
Linus Torvalds130fe052006-11-01 09:11:00 -0800387struct io_apic {
388 unsigned int index;
389 unsigned int unused[3];
390 unsigned int data;
391};
392
393static __attribute_const__ struct io_apic __iomem *io_apic_base(int idx)
394{
395 return (void __iomem *) __fix_to_virt(FIX_IO_APIC_BASE_0 + idx)
Alexey Starikovskiyec2cd0a2008-05-14 19:03:10 +0400396 + (mp_ioapics[idx].mp_apicaddr & ~PAGE_MASK);
Linus Torvalds130fe052006-11-01 09:11:00 -0800397}
398
399static inline unsigned int io_apic_read(unsigned int apic, unsigned int reg)
400{
401 struct io_apic __iomem *io_apic = io_apic_base(apic);
402 writel(reg, &io_apic->index);
403 return readl(&io_apic->data);
404}
405
406static inline void io_apic_write(unsigned int apic, unsigned int reg, unsigned int value)
407{
408 struct io_apic __iomem *io_apic = io_apic_base(apic);
409 writel(reg, &io_apic->index);
410 writel(value, &io_apic->data);
411}
412
413/*
414 * Re-write a value: to be used for read-modify-write
415 * cycles where the read already set up the index register.
416 *
417 * Older SiS APIC requires we rewrite the index register
418 */
419static inline void io_apic_modify(unsigned int apic, unsigned int reg, unsigned int value)
420{
Ingo Molnar54168ed2008-08-20 09:07:45 +0200421 struct io_apic __iomem *io_apic = io_apic_base(apic);
422 if (sis_apic_bug)
423 writel(reg, &io_apic->index);
Linus Torvalds130fe052006-11-01 09:11:00 -0800424 writel(value, &io_apic->data);
425}
426
Yinghai Lu047c8fd2008-08-19 20:50:41 -0700427static bool io_apic_level_ack_pending(unsigned int irq)
428{
429 struct irq_pin_list *entry;
430 unsigned long flags;
431 struct irq_cfg *cfg = irq_cfg(irq);
432
433 spin_lock_irqsave(&ioapic_lock, flags);
434 entry = cfg->irq_2_pin;
435 for (;;) {
436 unsigned int reg;
437 int pin;
438
439 if (!entry)
440 break;
441 pin = entry->pin;
442 reg = io_apic_read(entry->apic, 0x10 + pin*2);
443 /* Is the remote IRR bit set? */
444 if (reg & IO_APIC_REDIR_REMOTE_IRR) {
445 spin_unlock_irqrestore(&ioapic_lock, flags);
446 return true;
447 }
448 if (!entry->next)
449 break;
450 entry = entry->next;
451 }
452 spin_unlock_irqrestore(&ioapic_lock, flags);
453
454 return false;
455}
Yinghai Lu047c8fd2008-08-19 20:50:41 -0700456
Andi Kleencf4c6a22006-09-26 10:52:30 +0200457union entry_union {
458 struct { u32 w1, w2; };
459 struct IO_APIC_route_entry entry;
460};
461
462static struct IO_APIC_route_entry ioapic_read_entry(int apic, int pin)
463{
464 union entry_union eu;
465 unsigned long flags;
466 spin_lock_irqsave(&ioapic_lock, flags);
467 eu.w1 = io_apic_read(apic, 0x10 + 2 * pin);
468 eu.w2 = io_apic_read(apic, 0x11 + 2 * pin);
469 spin_unlock_irqrestore(&ioapic_lock, flags);
470 return eu.entry;
471}
472
Linus Torvaldsf9dadfa2006-11-01 10:05:35 -0800473/*
474 * When we write a new IO APIC routing entry, we need to write the high
475 * word first! If the mask bit in the low word is clear, we will enable
476 * the interrupt, and we need to make sure the entry is fully populated
477 * before that happens.
478 */
Andi Kleend15512f2006-12-07 02:14:07 +0100479static void
480__ioapic_write_entry(int apic, int pin, struct IO_APIC_route_entry e)
481{
482 union entry_union eu;
483 eu.entry = e;
484 io_apic_write(apic, 0x11 + 2*pin, eu.w2);
485 io_apic_write(apic, 0x10 + 2*pin, eu.w1);
486}
487
Andi Kleencf4c6a22006-09-26 10:52:30 +0200488static void ioapic_write_entry(int apic, int pin, struct IO_APIC_route_entry e)
489{
490 unsigned long flags;
Andi Kleencf4c6a22006-09-26 10:52:30 +0200491 spin_lock_irqsave(&ioapic_lock, flags);
Andi Kleend15512f2006-12-07 02:14:07 +0100492 __ioapic_write_entry(apic, pin, e);
Linus Torvaldsf9dadfa2006-11-01 10:05:35 -0800493 spin_unlock_irqrestore(&ioapic_lock, flags);
494}
495
496/*
497 * When we mask an IO APIC routing entry, we need to write the low
498 * word first, in order to set the mask bit before we change the
499 * high bits!
500 */
501static void ioapic_mask_entry(int apic, int pin)
502{
503 unsigned long flags;
504 union entry_union eu = { .entry.mask = 1 };
505
506 spin_lock_irqsave(&ioapic_lock, flags);
Andi Kleencf4c6a22006-09-26 10:52:30 +0200507 io_apic_write(apic, 0x10 + 2*pin, eu.w1);
508 io_apic_write(apic, 0x11 + 2*pin, eu.w2);
509 spin_unlock_irqrestore(&ioapic_lock, flags);
510}
511
Yinghai Lu497c9a12008-08-19 20:50:28 -0700512#ifdef CONFIG_SMP
513static void __target_IO_APIC_irq(unsigned int irq, unsigned int dest, u8 vector)
514{
515 int apic, pin;
516 struct irq_cfg *cfg;
517 struct irq_pin_list *entry;
518
519 cfg = irq_cfg(irq);
520 entry = cfg->irq_2_pin;
521 for (;;) {
522 unsigned int reg;
523
524 if (!entry)
525 break;
526
527 apic = entry->apic;
528 pin = entry->pin;
Ingo Molnar54168ed2008-08-20 09:07:45 +0200529#ifdef CONFIG_INTR_REMAP
530 /*
531 * With interrupt-remapping, destination information comes
532 * from interrupt-remapping table entry.
533 */
534 if (!irq_remapped(irq))
535 io_apic_write(apic, 0x11 + pin*2, dest);
536#else
Yinghai Lu497c9a12008-08-19 20:50:28 -0700537 io_apic_write(apic, 0x11 + pin*2, dest);
Ingo Molnar54168ed2008-08-20 09:07:45 +0200538#endif
Yinghai Lu497c9a12008-08-19 20:50:28 -0700539 reg = io_apic_read(apic, 0x10 + pin*2);
540 reg &= ~IO_APIC_REDIR_VECTOR_MASK;
541 reg |= vector;
Ingo Molnar54168ed2008-08-20 09:07:45 +0200542 io_apic_modify(apic, 0x10 + pin*2, reg);
Yinghai Lu497c9a12008-08-19 20:50:28 -0700543 if (!entry->next)
544 break;
545 entry = entry->next;
546 }
547}
Yinghai Luefa25592008-08-19 20:50:36 -0700548
549static int assign_irq_vector(int irq, cpumask_t mask);
550
Yinghai Lu497c9a12008-08-19 20:50:28 -0700551static void set_ioapic_affinity_irq(unsigned int irq, cpumask_t mask)
552{
553 struct irq_cfg *cfg;
554 unsigned long flags;
555 unsigned int dest;
556 cpumask_t tmp;
Ingo Molnar54168ed2008-08-20 09:07:45 +0200557 struct irq_desc *desc;
Yinghai Lu497c9a12008-08-19 20:50:28 -0700558
Yinghai Lu497c9a12008-08-19 20:50:28 -0700559 cpus_and(tmp, mask, cpu_online_map);
560 if (cpus_empty(tmp))
561 return;
562
Yinghai Lu047c8fd2008-08-19 20:50:41 -0700563 cfg = irq_cfg(irq);
Yinghai Lu497c9a12008-08-19 20:50:28 -0700564 if (assign_irq_vector(irq, mask))
565 return;
566
567 cpus_and(tmp, cfg->domain, mask);
Yinghai Lu497c9a12008-08-19 20:50:28 -0700568 dest = cpu_mask_to_apicid(tmp);
569 /*
570 * Only the high 8 bits are valid.
571 */
572 dest = SET_APIC_LOGICAL_ID(dest);
573
Ingo Molnar54168ed2008-08-20 09:07:45 +0200574 desc = irq_to_desc(irq);
Yinghai Lu497c9a12008-08-19 20:50:28 -0700575 spin_lock_irqsave(&ioapic_lock, flags);
576 __target_IO_APIC_irq(irq, dest, cfg->vector);
Ingo Molnar54168ed2008-08-20 09:07:45 +0200577 desc->affinity = mask;
Yinghai Lu497c9a12008-08-19 20:50:28 -0700578 spin_unlock_irqrestore(&ioapic_lock, flags);
579}
Yinghai Lu497c9a12008-08-19 20:50:28 -0700580#endif /* CONFIG_SMP */
581
Linus Torvalds1da177e2005-04-16 15:20:36 -0700582/*
583 * The common case is 1:1 IRQ<->pin mappings. Sometimes there are
584 * shared ISA-space IRQs, so we have to support them. We are super
585 * fast in the common case, and fast for shared ISA-space IRQs.
586 */
587static void add_pin_to_irq(unsigned int irq, int apic, int pin)
588{
Yinghai Lu0f978f42008-08-19 20:50:26 -0700589 struct irq_cfg *cfg;
590 struct irq_pin_list *entry;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700591
Yinghai Lu0f978f42008-08-19 20:50:26 -0700592 /* first time to refer irq_cfg, so with new */
593 cfg = irq_cfg_alloc(irq);
594 entry = cfg->irq_2_pin;
595 if (!entry) {
596 entry = get_one_free_irq_2_pin();
597 cfg->irq_2_pin = entry;
598 entry->apic = apic;
599 entry->pin = pin;
600 printk(KERN_DEBUG " 0 add_pin_to_irq: irq %d --> apic %d pin %d\n", irq, apic, pin);
601 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700602 }
Yinghai Lu0f978f42008-08-19 20:50:26 -0700603
604 while (entry->next) {
605 /* not again, please */
606 if (entry->apic == apic && entry->pin == pin)
607 return;
608
609 entry = entry->next;
610 }
611
612 entry->next = get_one_free_irq_2_pin();
613 entry = entry->next;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700614 entry->apic = apic;
615 entry->pin = pin;
Yinghai Lu0f978f42008-08-19 20:50:26 -0700616 printk(KERN_DEBUG " x add_pin_to_irq: irq %d --> apic %d pin %d\n", irq, apic, pin);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700617}
618
619/*
620 * Reroute an IRQ to a different pin.
621 */
622static void __init replace_pin_at_irq(unsigned int irq,
623 int oldapic, int oldpin,
624 int newapic, int newpin)
625{
Yinghai Lu0f978f42008-08-19 20:50:26 -0700626 struct irq_cfg *cfg = irq_cfg(irq);
627 struct irq_pin_list *entry = cfg->irq_2_pin;
628 int replaced = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700629
Yinghai Lu0f978f42008-08-19 20:50:26 -0700630 while (entry) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700631 if (entry->apic == oldapic && entry->pin == oldpin) {
632 entry->apic = newapic;
633 entry->pin = newpin;
Yinghai Lu0f978f42008-08-19 20:50:26 -0700634 replaced = 1;
635 /* every one is different, right? */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700636 break;
Yinghai Lu0f978f42008-08-19 20:50:26 -0700637 }
638 entry = entry->next;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700639 }
Yinghai Lu0f978f42008-08-19 20:50:26 -0700640
641 /* why? call replace before add? */
642 if (!replaced)
643 add_pin_to_irq(irq, newapic, newpin);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700644}
645
Yinghai Lu4e738e22008-08-19 20:50:47 -0700646#define __DO_ACTION(R, ACTION_ENABLE, ACTION_DISABLE, FINAL) \
Yinghai Lu047c8fd2008-08-19 20:50:41 -0700647 \
648{ \
649 int pin; \
650 struct irq_cfg *cfg; \
651 struct irq_pin_list *entry; \
652 \
653 cfg = irq_cfg(irq); \
654 entry = cfg->irq_2_pin; \
655 for (;;) { \
656 unsigned int reg; \
657 if (!entry) \
658 break; \
659 pin = entry->pin; \
660 reg = io_apic_read(entry->apic, 0x10 + R + pin*2); \
Yinghai Lu4e738e22008-08-19 20:50:47 -0700661 reg ACTION_DISABLE; \
662 reg ACTION_ENABLE; \
Yinghai Lu047c8fd2008-08-19 20:50:41 -0700663 io_apic_modify(entry->apic, 0x10 + R + pin*2, reg); \
664 FINAL; \
665 if (!entry->next) \
666 break; \
667 entry = entry->next; \
668 } \
669}
670
Yinghai Lu4e738e22008-08-19 20:50:47 -0700671#define DO_ACTION(name,R, ACTION_ENABLE, ACTION_DISABLE, FINAL) \
Yinghai Lu047c8fd2008-08-19 20:50:41 -0700672 \
673 static void name##_IO_APIC_irq (unsigned int irq) \
Yinghai Lu4e738e22008-08-19 20:50:47 -0700674 __DO_ACTION(R, ACTION_ENABLE, ACTION_DISABLE, FINAL)
Yinghai Lu047c8fd2008-08-19 20:50:41 -0700675
676/* mask = 0 */
Yinghai Lu4e738e22008-08-19 20:50:47 -0700677DO_ACTION(__unmask, 0, |= 0, &= ~IO_APIC_REDIR_MASKED, )
678
679#ifdef CONFIG_X86_64
680/*
681 * Synchronize the IO-APIC and the CPU by doing
682 * a dummy read from the IO-APIC
683 */
684static inline void io_apic_sync(unsigned int apic)
685{
686 struct io_apic __iomem *io_apic = io_apic_base(apic);
687 readl(&io_apic->data);
688}
689
690/* mask = 1 */
691DO_ACTION(__mask, 0, |= IO_APIC_REDIR_MASKED, &= ~0, io_apic_sync(entry->apic))
Yinghai Lu047c8fd2008-08-19 20:50:41 -0700692
693#else
694
Linus Torvalds1da177e2005-04-16 15:20:36 -0700695/* mask = 1 */
Yinghai Lu4e738e22008-08-19 20:50:47 -0700696DO_ACTION(__mask, 0, |= IO_APIC_REDIR_MASKED, &= ~0, )
Linus Torvalds1da177e2005-04-16 15:20:36 -0700697
698/* mask = 1, trigger = 0 */
Yinghai Lu4e738e22008-08-19 20:50:47 -0700699DO_ACTION(__mask_and_edge, 0, |= IO_APIC_REDIR_MASKED, &= ~IO_APIC_REDIR_LEVEL_TRIGGER, )
Linus Torvalds1da177e2005-04-16 15:20:36 -0700700
701/* mask = 0, trigger = 1 */
Yinghai Lu4e738e22008-08-19 20:50:47 -0700702DO_ACTION(__unmask_and_level, 0, |= IO_APIC_REDIR_LEVEL_TRIGGER, &= ~IO_APIC_REDIR_MASKED, )
Linus Torvalds1da177e2005-04-16 15:20:36 -0700703
Yinghai Lu047c8fd2008-08-19 20:50:41 -0700704#endif
705
Ingo Molnar54168ed2008-08-20 09:07:45 +0200706static void mask_IO_APIC_irq (unsigned int irq)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700707{
708 unsigned long flags;
709
710 spin_lock_irqsave(&ioapic_lock, flags);
711 __mask_IO_APIC_irq(irq);
712 spin_unlock_irqrestore(&ioapic_lock, flags);
713}
714
Ingo Molnar54168ed2008-08-20 09:07:45 +0200715static void unmask_IO_APIC_irq (unsigned int irq)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700716{
717 unsigned long flags;
718
719 spin_lock_irqsave(&ioapic_lock, flags);
720 __unmask_IO_APIC_irq(irq);
721 spin_unlock_irqrestore(&ioapic_lock, flags);
722}
723
724static void clear_IO_APIC_pin(unsigned int apic, unsigned int pin)
725{
726 struct IO_APIC_route_entry entry;
Paolo Ciarrocchi36062442008-06-08 13:07:18 +0200727
Linus Torvalds1da177e2005-04-16 15:20:36 -0700728 /* Check delivery_mode to be sure we're not clearing an SMI pin */
Andi Kleencf4c6a22006-09-26 10:52:30 +0200729 entry = ioapic_read_entry(apic, pin);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700730 if (entry.delivery_mode == dest_SMI)
731 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700732 /*
733 * Disable it in the IO-APIC irq-routing table:
734 */
Linus Torvaldsf9dadfa2006-11-01 10:05:35 -0800735 ioapic_mask_entry(apic, pin);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700736}
737
Ingo Molnar54168ed2008-08-20 09:07:45 +0200738static void clear_IO_APIC (void)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700739{
740 int apic, pin;
741
742 for (apic = 0; apic < nr_ioapics; apic++)
743 for (pin = 0; pin < nr_ioapic_registers[apic]; pin++)
744 clear_IO_APIC_pin(apic, pin);
745}
746
Ingo Molnar54168ed2008-08-20 09:07:45 +0200747#if !defined(CONFIG_SMP) && defined(CONFIG_X86_32)
Harvey Harrison75604d72008-01-30 13:31:17 +0100748void send_IPI_self(int vector)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700749{
750 unsigned int cfg;
751
752 /*
753 * Wait for idle.
754 */
755 apic_wait_icr_idle();
756 cfg = APIC_DM_FIXED | APIC_DEST_SELF | vector | APIC_DEST_LOGICAL;
757 /*
758 * Send the IPI. The write to APIC_ICR fires this off.
759 */
Maciej W. Rozycki593f4a72008-07-16 19:15:30 +0100760 apic_write(APIC_ICR, cfg);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700761}
Ingo Molnar54168ed2008-08-20 09:07:45 +0200762#endif /* !CONFIG_SMP && CONFIG_X86_32*/
Linus Torvalds1da177e2005-04-16 15:20:36 -0700763
Ingo Molnar54168ed2008-08-20 09:07:45 +0200764#ifdef CONFIG_X86_32
Linus Torvalds1da177e2005-04-16 15:20:36 -0700765/*
766 * support for broken MP BIOSs, enables hand-redirection of PIRQ0-7 to
767 * specific CPU-side IRQs.
768 */
769
770#define MAX_PIRQS 8
771static int pirq_entries [MAX_PIRQS];
772static int pirqs_enabled;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700773
Linus Torvalds1da177e2005-04-16 15:20:36 -0700774static int __init ioapic_pirq_setup(char *str)
775{
776 int i, max;
777 int ints[MAX_PIRQS+1];
778
779 get_options(str, ARRAY_SIZE(ints), ints);
780
781 for (i = 0; i < MAX_PIRQS; i++)
782 pirq_entries[i] = -1;
783
784 pirqs_enabled = 1;
785 apic_printk(APIC_VERBOSE, KERN_INFO
786 "PIRQ redirection, working around broken MP-BIOS.\n");
787 max = MAX_PIRQS;
788 if (ints[0] < MAX_PIRQS)
789 max = ints[0];
790
791 for (i = 0; i < max; i++) {
792 apic_printk(APIC_VERBOSE, KERN_DEBUG
793 "... PIRQ%d -> IRQ %d\n", i, ints[i+1]);
794 /*
795 * PIRQs are mapped upside down, usually.
796 */
797 pirq_entries[MAX_PIRQS-i-1] = ints[i+1];
798 }
799 return 1;
800}
801
802__setup("pirq=", ioapic_pirq_setup);
Ingo Molnar54168ed2008-08-20 09:07:45 +0200803#endif /* CONFIG_X86_32 */
804
805#ifdef CONFIG_INTR_REMAP
806/* I/O APIC RTE contents at the OS boot up */
807static struct IO_APIC_route_entry *early_ioapic_entries[MAX_IO_APICS];
808
809/*
810 * Saves and masks all the unmasked IO-APIC RTE's
811 */
812int save_mask_IO_APIC_setup(void)
813{
814 union IO_APIC_reg_01 reg_01;
815 unsigned long flags;
816 int apic, pin;
817
818 /*
819 * The number of IO-APIC IRQ registers (== #pins):
820 */
821 for (apic = 0; apic < nr_ioapics; apic++) {
822 spin_lock_irqsave(&ioapic_lock, flags);
823 reg_01.raw = io_apic_read(apic, 1);
824 spin_unlock_irqrestore(&ioapic_lock, flags);
825 nr_ioapic_registers[apic] = reg_01.bits.entries+1;
826 }
827
828 for (apic = 0; apic < nr_ioapics; apic++) {
829 early_ioapic_entries[apic] =
830 kzalloc(sizeof(struct IO_APIC_route_entry) *
831 nr_ioapic_registers[apic], GFP_KERNEL);
832 if (!early_ioapic_entries[apic])
833 return -ENOMEM;
834 }
835
836 for (apic = 0; apic < nr_ioapics; apic++)
837 for (pin = 0; pin < nr_ioapic_registers[apic]; pin++) {
838 struct IO_APIC_route_entry entry;
839
840 entry = early_ioapic_entries[apic][pin] =
841 ioapic_read_entry(apic, pin);
842 if (!entry.mask) {
843 entry.mask = 1;
844 ioapic_write_entry(apic, pin, entry);
845 }
846 }
847 return 0;
848}
849
850void restore_IO_APIC_setup(void)
851{
852 int apic, pin;
853
854 for (apic = 0; apic < nr_ioapics; apic++)
855 for (pin = 0; pin < nr_ioapic_registers[apic]; pin++)
856 ioapic_write_entry(apic, pin,
857 early_ioapic_entries[apic][pin]);
858}
859
860void reinit_intr_remapped_IO_APIC(int intr_remapping)
861{
862 /*
863 * for now plain restore of previous settings.
864 * TBD: In the case of OS enabling interrupt-remapping,
865 * IO-APIC RTE's need to be setup to point to interrupt-remapping
866 * table entries. for now, do a plain restore, and wait for
867 * the setup_IO_APIC_irqs() to do proper initialization.
868 */
869 restore_IO_APIC_setup();
870}
871#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -0700872
873/*
874 * Find the IRQ entry number of a certain pin.
875 */
876static int find_irq_entry(int apic, int pin, int type)
877{
878 int i;
879
880 for (i = 0; i < mp_irq_entries; i++)
Alexey Starikovskiy2fddb6e282008-05-14 19:03:17 +0400881 if (mp_irqs[i].mp_irqtype == type &&
882 (mp_irqs[i].mp_dstapic == mp_ioapics[apic].mp_apicid ||
883 mp_irqs[i].mp_dstapic == MP_APIC_ALL) &&
884 mp_irqs[i].mp_dstirq == pin)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700885 return i;
886
887 return -1;
888}
889
890/*
891 * Find the pin to which IRQ[irq] (ISA) is connected
892 */
Eric W. Biedermanfcfd6362005-10-30 14:59:39 -0800893static int __init find_isa_irq_pin(int irq, int type)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700894{
895 int i;
896
897 for (i = 0; i < mp_irq_entries; i++) {
Alexey Starikovskiy2fddb6e282008-05-14 19:03:17 +0400898 int lbus = mp_irqs[i].mp_srcbus;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700899
Alexey Starikovskiyd27e2b82008-03-20 14:54:18 +0300900 if (test_bit(lbus, mp_bus_not_pci) &&
Alexey Starikovskiy2fddb6e282008-05-14 19:03:17 +0400901 (mp_irqs[i].mp_irqtype == type) &&
902 (mp_irqs[i].mp_srcbusirq == irq))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700903
Alexey Starikovskiy2fddb6e282008-05-14 19:03:17 +0400904 return mp_irqs[i].mp_dstirq;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700905 }
906 return -1;
907}
908
Eric W. Biedermanfcfd6362005-10-30 14:59:39 -0800909static int __init find_isa_irq_apic(int irq, int type)
910{
911 int i;
912
913 for (i = 0; i < mp_irq_entries; i++) {
Alexey Starikovskiy2fddb6e282008-05-14 19:03:17 +0400914 int lbus = mp_irqs[i].mp_srcbus;
Eric W. Biedermanfcfd6362005-10-30 14:59:39 -0800915
Alexey Starikovskiy73b29612008-03-20 14:54:24 +0300916 if (test_bit(lbus, mp_bus_not_pci) &&
Alexey Starikovskiy2fddb6e282008-05-14 19:03:17 +0400917 (mp_irqs[i].mp_irqtype == type) &&
918 (mp_irqs[i].mp_srcbusirq == irq))
Eric W. Biedermanfcfd6362005-10-30 14:59:39 -0800919 break;
920 }
921 if (i < mp_irq_entries) {
922 int apic;
Ingo Molnar54168ed2008-08-20 09:07:45 +0200923 for(apic = 0; apic < nr_ioapics; apic++) {
Alexey Starikovskiy2fddb6e282008-05-14 19:03:17 +0400924 if (mp_ioapics[apic].mp_apicid == mp_irqs[i].mp_dstapic)
Eric W. Biedermanfcfd6362005-10-30 14:59:39 -0800925 return apic;
926 }
927 }
928
929 return -1;
930}
931
Linus Torvalds1da177e2005-04-16 15:20:36 -0700932/*
933 * Find a specific PCI IRQ entry.
934 * Not an __init, possibly needed by modules
935 */
936static int pin_2_irq(int idx, int apic, int pin);
937
938int IO_APIC_get_PCI_irq_vector(int bus, int slot, int pin)
939{
940 int apic, i, best_guess = -1;
941
Ingo Molnar54168ed2008-08-20 09:07:45 +0200942 apic_printk(APIC_DEBUG, "querying PCI -> IRQ mapping bus:%d, slot:%d, pin:%d.\n",
943 bus, slot, pin);
Alexey Starikovskiyce6444d2008-05-19 19:47:09 +0400944 if (test_bit(bus, mp_bus_not_pci)) {
Ingo Molnar54168ed2008-08-20 09:07:45 +0200945 apic_printk(APIC_VERBOSE, "PCI BIOS passed nonexistent PCI bus %d!\n", bus);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700946 return -1;
947 }
948 for (i = 0; i < mp_irq_entries; i++) {
Alexey Starikovskiy2fddb6e282008-05-14 19:03:17 +0400949 int lbus = mp_irqs[i].mp_srcbus;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700950
951 for (apic = 0; apic < nr_ioapics; apic++)
Alexey Starikovskiy2fddb6e282008-05-14 19:03:17 +0400952 if (mp_ioapics[apic].mp_apicid == mp_irqs[i].mp_dstapic ||
953 mp_irqs[i].mp_dstapic == MP_APIC_ALL)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700954 break;
955
Alexey Starikovskiy47cab822008-03-20 14:54:30 +0300956 if (!test_bit(lbus, mp_bus_not_pci) &&
Alexey Starikovskiy2fddb6e282008-05-14 19:03:17 +0400957 !mp_irqs[i].mp_irqtype &&
Linus Torvalds1da177e2005-04-16 15:20:36 -0700958 (bus == lbus) &&
Alexey Starikovskiy2fddb6e282008-05-14 19:03:17 +0400959 (slot == ((mp_irqs[i].mp_srcbusirq >> 2) & 0x1f))) {
Ingo Molnar54168ed2008-08-20 09:07:45 +0200960 int irq = pin_2_irq(i,apic,mp_irqs[i].mp_dstirq);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700961
962 if (!(apic || IO_APIC_IRQ(irq)))
963 continue;
964
Alexey Starikovskiy2fddb6e282008-05-14 19:03:17 +0400965 if (pin == (mp_irqs[i].mp_srcbusirq & 3))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700966 return irq;
967 /*
968 * Use the first all-but-pin matching entry as a
969 * best-guess fuzzy result for broken mptables.
970 */
971 if (best_guess < 0)
972 best_guess = irq;
973 }
974 }
975 return best_guess;
976}
Ingo Molnar54168ed2008-08-20 09:07:45 +0200977
Alexey Dobriyan129f6942005-06-23 00:08:33 -0700978EXPORT_SYMBOL(IO_APIC_get_PCI_irq_vector);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700979
Alexey Starikovskiyc0a282c2008-03-20 14:55:02 +0300980#if defined(CONFIG_EISA) || defined(CONFIG_MCA)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700981/*
982 * EISA Edge/Level control register, ELCR
983 */
984static int EISA_ELCR(unsigned int irq)
985{
986 if (irq < 16) {
987 unsigned int port = 0x4d0 + (irq >> 3);
988 return (inb(port) >> (irq & 7)) & 1;
989 }
990 apic_printk(APIC_VERBOSE, KERN_INFO
991 "Broken MPtable reports ISA irq %d\n", irq);
992 return 0;
993}
Ingo Molnar54168ed2008-08-20 09:07:45 +0200994
Alexey Starikovskiyc0a282c2008-03-20 14:55:02 +0300995#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -0700996
Alexey Starikovskiy67288012008-03-20 14:54:36 +0300997/* ISA interrupts are always polarity zero edge triggered,
998 * when listed as conforming in the MP table. */
999
1000#define default_ISA_trigger(idx) (0)
1001#define default_ISA_polarity(idx) (0)
1002
Linus Torvalds1da177e2005-04-16 15:20:36 -07001003/* EISA interrupts are always polarity zero and can be edge or level
1004 * trigger depending on the ELCR value. If an interrupt is listed as
1005 * EISA conforming in the MP table, that means its trigger type must
1006 * be read in from the ELCR */
1007
Alexey Starikovskiy2fddb6e282008-05-14 19:03:17 +04001008#define default_EISA_trigger(idx) (EISA_ELCR(mp_irqs[idx].mp_srcbusirq))
Alexey Starikovskiy67288012008-03-20 14:54:36 +03001009#define default_EISA_polarity(idx) default_ISA_polarity(idx)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001010
1011/* PCI interrupts are always polarity one level triggered,
1012 * when listed as conforming in the MP table. */
1013
1014#define default_PCI_trigger(idx) (1)
1015#define default_PCI_polarity(idx) (1)
1016
1017/* MCA interrupts are always polarity zero level triggered,
1018 * when listed as conforming in the MP table. */
1019
1020#define default_MCA_trigger(idx) (1)
Alexey Starikovskiy67288012008-03-20 14:54:36 +03001021#define default_MCA_polarity(idx) default_ISA_polarity(idx)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001022
Shaohua Li61fd47e2007-11-17 01:05:28 -05001023static int MPBIOS_polarity(int idx)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001024{
Alexey Starikovskiy2fddb6e282008-05-14 19:03:17 +04001025 int bus = mp_irqs[idx].mp_srcbus;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001026 int polarity;
1027
1028 /*
1029 * Determine IRQ line polarity (high active or low active):
1030 */
Ingo Molnar54168ed2008-08-20 09:07:45 +02001031 switch (mp_irqs[idx].mp_irqflag & 3)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001032 {
Ingo Molnar54168ed2008-08-20 09:07:45 +02001033 case 0: /* conforms, ie. bus-type dependent polarity */
1034 if (test_bit(bus, mp_bus_not_pci))
1035 polarity = default_ISA_polarity(idx);
1036 else
1037 polarity = default_PCI_polarity(idx);
1038 break;
1039 case 1: /* high active */
1040 {
1041 polarity = 0;
1042 break;
1043 }
1044 case 2: /* reserved */
1045 {
1046 printk(KERN_WARNING "broken BIOS!!\n");
1047 polarity = 1;
1048 break;
1049 }
1050 case 3: /* low active */
1051 {
1052 polarity = 1;
1053 break;
1054 }
1055 default: /* invalid */
1056 {
1057 printk(KERN_WARNING "broken BIOS!!\n");
1058 polarity = 1;
1059 break;
1060 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001061 }
1062 return polarity;
1063}
1064
1065static int MPBIOS_trigger(int idx)
1066{
Alexey Starikovskiy2fddb6e282008-05-14 19:03:17 +04001067 int bus = mp_irqs[idx].mp_srcbus;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001068 int trigger;
1069
1070 /*
1071 * Determine IRQ trigger mode (edge or level sensitive):
1072 */
Ingo Molnar54168ed2008-08-20 09:07:45 +02001073 switch ((mp_irqs[idx].mp_irqflag>>2) & 3)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001074 {
Ingo Molnar54168ed2008-08-20 09:07:45 +02001075 case 0: /* conforms, ie. bus-type dependent */
1076 if (test_bit(bus, mp_bus_not_pci))
1077 trigger = default_ISA_trigger(idx);
1078 else
1079 trigger = default_PCI_trigger(idx);
Alexey Starikovskiyc0a282c2008-03-20 14:55:02 +03001080#if defined(CONFIG_EISA) || defined(CONFIG_MCA)
Ingo Molnar54168ed2008-08-20 09:07:45 +02001081 switch (mp_bus_id_to_type[bus]) {
1082 case MP_BUS_ISA: /* ISA pin */
1083 {
1084 /* set before the switch */
1085 break;
1086 }
1087 case MP_BUS_EISA: /* EISA pin */
1088 {
1089 trigger = default_EISA_trigger(idx);
1090 break;
1091 }
1092 case MP_BUS_PCI: /* PCI pin */
1093 {
1094 /* set before the switch */
1095 break;
1096 }
1097 case MP_BUS_MCA: /* MCA pin */
1098 {
1099 trigger = default_MCA_trigger(idx);
1100 break;
1101 }
1102 default:
1103 {
1104 printk(KERN_WARNING "broken BIOS!!\n");
1105 trigger = 1;
1106 break;
1107 }
1108 }
1109#endif
1110 break;
1111 case 1: /* edge */
Paolo Ciarrocchi36062442008-06-08 13:07:18 +02001112 {
Ingo Molnar54168ed2008-08-20 09:07:45 +02001113 trigger = 0;
Paolo Ciarrocchi36062442008-06-08 13:07:18 +02001114 break;
1115 }
Ingo Molnar54168ed2008-08-20 09:07:45 +02001116 case 2: /* reserved */
Paolo Ciarrocchi36062442008-06-08 13:07:18 +02001117 {
1118 printk(KERN_WARNING "broken BIOS!!\n");
1119 trigger = 1;
1120 break;
1121 }
Ingo Molnar54168ed2008-08-20 09:07:45 +02001122 case 3: /* level */
1123 {
1124 trigger = 1;
1125 break;
1126 }
1127 default: /* invalid */
1128 {
1129 printk(KERN_WARNING "broken BIOS!!\n");
1130 trigger = 0;
1131 break;
1132 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001133 }
1134 return trigger;
1135}
1136
1137static inline int irq_polarity(int idx)
1138{
1139 return MPBIOS_polarity(idx);
1140}
1141
1142static inline int irq_trigger(int idx)
1143{
1144 return MPBIOS_trigger(idx);
1145}
1146
Yinghai Luefa25592008-08-19 20:50:36 -07001147int (*ioapic_renumber_irq)(int ioapic, int irq);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001148static int pin_2_irq(int idx, int apic, int pin)
1149{
1150 int irq, i;
Alexey Starikovskiy2fddb6e282008-05-14 19:03:17 +04001151 int bus = mp_irqs[idx].mp_srcbus;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001152
1153 /*
1154 * Debugging check, we are in big trouble if this message pops up!
1155 */
Alexey Starikovskiy2fddb6e282008-05-14 19:03:17 +04001156 if (mp_irqs[idx].mp_dstirq != pin)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001157 printk(KERN_ERR "broken BIOS or MPTABLE parser, ayiee!!\n");
1158
Ingo Molnar54168ed2008-08-20 09:07:45 +02001159 if (test_bit(bus, mp_bus_not_pci)) {
Alexey Starikovskiy2fddb6e282008-05-14 19:03:17 +04001160 irq = mp_irqs[idx].mp_srcbusirq;
Ingo Molnar54168ed2008-08-20 09:07:45 +02001161 } else {
Alexey Starikovskiy643befe2008-03-20 14:54:49 +03001162 /*
1163 * PCI IRQs are mapped in order
1164 */
1165 i = irq = 0;
1166 while (i < apic)
1167 irq += nr_ioapic_registers[i++];
1168 irq += pin;
Ingo Molnar54168ed2008-08-20 09:07:45 +02001169 /*
1170 * For MPS mode, so far only needed by ES7000 platform
1171 */
1172 if (ioapic_renumber_irq)
1173 irq = ioapic_renumber_irq(apic, irq);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001174 }
1175
Ingo Molnar54168ed2008-08-20 09:07:45 +02001176#ifdef CONFIG_X86_32
Linus Torvalds1da177e2005-04-16 15:20:36 -07001177 /*
1178 * PCI IRQ command line redirection. Yes, limits are hardcoded.
1179 */
1180 if ((pin >= 16) && (pin <= 23)) {
1181 if (pirq_entries[pin-16] != -1) {
1182 if (!pirq_entries[pin-16]) {
1183 apic_printk(APIC_VERBOSE, KERN_DEBUG
1184 "disabling PIRQ%d\n", pin-16);
1185 } else {
1186 irq = pirq_entries[pin-16];
1187 apic_printk(APIC_VERBOSE, KERN_DEBUG
1188 "using PIRQ%d -> IRQ %d\n",
1189 pin-16, irq);
1190 }
1191 }
1192 }
Ingo Molnar54168ed2008-08-20 09:07:45 +02001193#endif
1194
Linus Torvalds1da177e2005-04-16 15:20:36 -07001195 return irq;
1196}
1197
Yinghai Lu497c9a12008-08-19 20:50:28 -07001198void lock_vector_lock(void)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001199{
Yinghai Lu497c9a12008-08-19 20:50:28 -07001200 /* Used to the online set of cpus does not change
1201 * during assign_irq_vector.
1202 */
1203 spin_lock(&vector_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001204}
1205
Yinghai Lu497c9a12008-08-19 20:50:28 -07001206void unlock_vector_lock(void)
Eric W. Biedermanace80ab2006-10-04 02:16:47 -07001207{
Yinghai Lu497c9a12008-08-19 20:50:28 -07001208 spin_unlock(&vector_lock);
1209}
1210
1211static int __assign_irq_vector(int irq, cpumask_t mask)
1212{
Yinghai Lu047c8fd2008-08-19 20:50:41 -07001213 /*
1214 * NOTE! The local APIC isn't very good at handling
1215 * multiple interrupts at the same interrupt level.
1216 * As the interrupt level is determined by taking the
1217 * vector number and shifting that right by 4, we
1218 * want to spread these out a bit so that they don't
1219 * all fall in the same interrupt level.
1220 *
1221 * Also, we've got to be careful not to trash gate
1222 * 0x80, because int 0x80 is hm, kind of importantish. ;)
1223 */
Ingo Molnar54168ed2008-08-20 09:07:45 +02001224 static int current_vector = FIRST_DEVICE_VECTOR, current_offset = 0;
1225 unsigned int old_vector;
1226 int cpu;
1227 struct irq_cfg *cfg;
Yinghai Lu497c9a12008-08-19 20:50:28 -07001228
Ingo Molnar54168ed2008-08-20 09:07:45 +02001229 cfg = irq_cfg(irq);
Yinghai Lu497c9a12008-08-19 20:50:28 -07001230
Ingo Molnar54168ed2008-08-20 09:07:45 +02001231 /* Only try and allocate irqs on cpus that are present */
1232 cpus_and(mask, mask, cpu_online_map);
Yinghai Lu497c9a12008-08-19 20:50:28 -07001233
Ingo Molnar54168ed2008-08-20 09:07:45 +02001234 if ((cfg->move_in_progress) || cfg->move_cleanup_count)
1235 return -EBUSY;
Yinghai Lu497c9a12008-08-19 20:50:28 -07001236
Ingo Molnar54168ed2008-08-20 09:07:45 +02001237 old_vector = cfg->vector;
1238 if (old_vector) {
1239 cpumask_t tmp;
1240 cpus_and(tmp, cfg->domain, mask);
1241 if (!cpus_empty(tmp))
1242 return 0;
1243 }
Yinghai Lu497c9a12008-08-19 20:50:28 -07001244
Ingo Molnar54168ed2008-08-20 09:07:45 +02001245 for_each_cpu_mask_nr(cpu, mask) {
1246 cpumask_t domain, new_mask;
1247 int new_cpu;
1248 int vector, offset;
Yinghai Lu497c9a12008-08-19 20:50:28 -07001249
Ingo Molnar54168ed2008-08-20 09:07:45 +02001250 domain = vector_allocation_domain(cpu);
1251 cpus_and(new_mask, domain, cpu_online_map);
Yinghai Lu497c9a12008-08-19 20:50:28 -07001252
Ingo Molnar54168ed2008-08-20 09:07:45 +02001253 vector = current_vector;
1254 offset = current_offset;
Yinghai Lu497c9a12008-08-19 20:50:28 -07001255next:
Ingo Molnar54168ed2008-08-20 09:07:45 +02001256 vector += 8;
1257 if (vector >= first_system_vector) {
1258 /* If we run out of vectors on large boxen, must share them. */
1259 offset = (offset + 1) % 8;
1260 vector = FIRST_DEVICE_VECTOR + offset;
Yinghai Lu7a959cf2008-08-19 20:50:32 -07001261 }
Ingo Molnar54168ed2008-08-20 09:07:45 +02001262 if (unlikely(current_vector == vector))
1263 continue;
1264#ifdef CONFIG_X86_64
1265 if (vector == IA32_SYSCALL_VECTOR)
1266 goto next;
1267#else
1268 if (vector == SYSCALL_VECTOR)
1269 goto next;
1270#endif
1271 for_each_cpu_mask_nr(new_cpu, new_mask)
1272 if (per_cpu(vector_irq, new_cpu)[vector] != -1)
1273 goto next;
1274 /* Found one! */
1275 current_vector = vector;
1276 current_offset = offset;
1277 if (old_vector) {
1278 cfg->move_in_progress = 1;
1279 cfg->old_domain = cfg->domain;
1280 }
1281 for_each_cpu_mask_nr(new_cpu, new_mask)
1282 per_cpu(vector_irq, new_cpu)[vector] = irq;
1283 cfg->vector = vector;
1284 cfg->domain = domain;
1285 return 0;
1286 }
1287 return -ENOSPC;
Yinghai Lu497c9a12008-08-19 20:50:28 -07001288}
1289
1290static int assign_irq_vector(int irq, cpumask_t mask)
1291{
1292 int err;
Eric W. Biedermanace80ab2006-10-04 02:16:47 -07001293 unsigned long flags;
Eric W. Biedermanace80ab2006-10-04 02:16:47 -07001294
1295 spin_lock_irqsave(&vector_lock, flags);
Yinghai Lu497c9a12008-08-19 20:50:28 -07001296 err = __assign_irq_vector(irq, mask);
Eric W. Biedermanace80ab2006-10-04 02:16:47 -07001297 spin_unlock_irqrestore(&vector_lock, flags);
Yinghai Lu497c9a12008-08-19 20:50:28 -07001298 return err;
1299}
1300
1301static void __clear_irq_vector(int irq)
1302{
1303 struct irq_cfg *cfg;
1304 cpumask_t mask;
1305 int cpu, vector;
1306
1307 cfg = irq_cfg(irq);
1308 BUG_ON(!cfg->vector);
1309
1310 vector = cfg->vector;
1311 cpus_and(mask, cfg->domain, cpu_online_map);
1312 for_each_cpu_mask_nr(cpu, mask)
1313 per_cpu(vector_irq, cpu)[vector] = -1;
1314
1315 cfg->vector = 0;
1316 cpus_clear(cfg->domain);
1317}
1318
1319void __setup_vector_irq(int cpu)
1320{
1321 /* Initialize vector_irq on a new cpu */
1322 /* This function must be called with vector_lock held */
1323 int irq, vector;
1324 struct irq_cfg *cfg;
1325
1326 /* Mark the inuse vectors */
Yinghai Lu8f09cd22008-08-19 20:50:51 -07001327 for_each_irq_cfg(irq, cfg) {
Yinghai Lu497c9a12008-08-19 20:50:28 -07001328 if (!cpu_isset(cpu, cfg->domain))
1329 continue;
1330 vector = cfg->vector;
Yinghai Lu497c9a12008-08-19 20:50:28 -07001331 per_cpu(vector_irq, cpu)[vector] = irq;
1332 }
1333 /* Mark the free vectors */
1334 for (vector = 0; vector < NR_VECTORS; ++vector) {
1335 irq = per_cpu(vector_irq, cpu)[vector];
1336 if (irq < 0)
1337 continue;
1338
1339 cfg = irq_cfg(irq);
1340 if (!cpu_isset(cpu, cfg->domain))
1341 per_cpu(vector_irq, cpu)[vector] = -1;
Ingo Molnar54168ed2008-08-20 09:07:45 +02001342 }
Eric W. Biedermanace80ab2006-10-04 02:16:47 -07001343}
Glauber Costa3fde6902008-05-28 20:34:19 -07001344
Ingo Molnarf5b9ed72006-10-04 02:16:26 -07001345static struct irq_chip ioapic_chip;
Ingo Molnar54168ed2008-08-20 09:07:45 +02001346#ifdef CONFIG_INTR_REMAP
1347static struct irq_chip ir_ioapic_chip;
1348#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -07001349
Ingo Molnar54168ed2008-08-20 09:07:45 +02001350#define IOAPIC_AUTO -1
1351#define IOAPIC_EDGE 0
1352#define IOAPIC_LEVEL 1
Linus Torvalds1da177e2005-04-16 15:20:36 -07001353
Yinghai Lu047c8fd2008-08-19 20:50:41 -07001354#ifdef CONFIG_X86_32
Yinghai Lu1d025192008-08-19 20:50:34 -07001355static inline int IO_APIC_irq_trigger(int irq)
1356{
Ingo Molnar54168ed2008-08-20 09:07:45 +02001357 int apic, idx, pin;
Yinghai Lu1d025192008-08-19 20:50:34 -07001358
Ingo Molnar54168ed2008-08-20 09:07:45 +02001359 for (apic = 0; apic < nr_ioapics; apic++) {
1360 for (pin = 0; pin < nr_ioapic_registers[apic]; pin++) {
1361 idx = find_irq_entry(apic, pin, mp_INT);
1362 if ((idx != -1) && (irq == pin_2_irq(idx, apic, pin)))
1363 return irq_trigger(idx);
1364 }
1365 }
1366 /*
1367 * nonexistent IRQs are edge default
1368 */
1369 return 0;
Yinghai Lu1d025192008-08-19 20:50:34 -07001370}
Yinghai Lu047c8fd2008-08-19 20:50:41 -07001371#else
1372static inline int IO_APIC_irq_trigger(int irq)
1373{
Ingo Molnar54168ed2008-08-20 09:07:45 +02001374 return 1;
Yinghai Lu047c8fd2008-08-19 20:50:41 -07001375}
1376#endif
Yinghai Lu1d025192008-08-19 20:50:34 -07001377
Yinghai Lu497c9a12008-08-19 20:50:28 -07001378static void ioapic_register_intr(int irq, unsigned long trigger)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001379{
Yinghai Lu08678b02008-08-19 20:50:05 -07001380 struct irq_desc *desc;
1381
Yinghai Lu199751d2008-08-19 20:50:27 -07001382 /* first time to use this irq_desc */
1383 if (irq < 16)
1384 desc = irq_to_desc(irq);
1385 else
1386 desc = irq_to_desc_alloc(irq);
1387
Jan Beulich6ebcc002006-06-26 13:56:46 +02001388 if ((trigger == IOAPIC_AUTO && IO_APIC_irq_trigger(irq)) ||
Yinghai Lu047c8fd2008-08-19 20:50:41 -07001389 trigger == IOAPIC_LEVEL)
Yinghai Lu08678b02008-08-19 20:50:05 -07001390 desc->status |= IRQ_LEVEL;
Yinghai Lu047c8fd2008-08-19 20:50:41 -07001391 else
1392 desc->status &= ~IRQ_LEVEL;
1393
Ingo Molnar54168ed2008-08-20 09:07:45 +02001394#ifdef CONFIG_INTR_REMAP
1395 if (irq_remapped(irq)) {
1396 desc->status |= IRQ_MOVE_PCNTXT;
1397 if (trigger)
1398 set_irq_chip_and_handler_name(irq, &ir_ioapic_chip,
1399 handle_fasteoi_irq,
1400 "fasteoi");
1401 else
1402 set_irq_chip_and_handler_name(irq, &ir_ioapic_chip,
1403 handle_edge_irq, "edge");
1404 return;
1405 }
1406#endif
Yinghai Lu047c8fd2008-08-19 20:50:41 -07001407 if ((trigger == IOAPIC_AUTO && IO_APIC_irq_trigger(irq)) ||
1408 trigger == IOAPIC_LEVEL)
Ingo Molnara460e742006-10-17 00:10:03 -07001409 set_irq_chip_and_handler_name(irq, &ioapic_chip,
Ingo Molnar54168ed2008-08-20 09:07:45 +02001410 handle_fasteoi_irq,
1411 "fasteoi");
Yinghai Lu047c8fd2008-08-19 20:50:41 -07001412 else
Ingo Molnara460e742006-10-17 00:10:03 -07001413 set_irq_chip_and_handler_name(irq, &ioapic_chip,
Ingo Molnar54168ed2008-08-20 09:07:45 +02001414 handle_edge_irq, "edge");
Yinghai Lu497c9a12008-08-19 20:50:28 -07001415}
1416
1417static int setup_ioapic_entry(int apic, int irq,
1418 struct IO_APIC_route_entry *entry,
1419 unsigned int destination, int trigger,
1420 int polarity, int vector)
1421{
1422 /*
1423 * add it to the IO-APIC irq-routing table:
1424 */
1425 memset(entry,0,sizeof(*entry));
1426
Ingo Molnar54168ed2008-08-20 09:07:45 +02001427#ifdef CONFIG_INTR_REMAP
1428 if (intr_remapping_enabled) {
1429 struct intel_iommu *iommu = map_ioapic_to_ir(apic);
1430 struct irte irte;
1431 struct IR_IO_APIC_route_entry *ir_entry =
1432 (struct IR_IO_APIC_route_entry *) entry;
1433 int index;
Yinghai Lu497c9a12008-08-19 20:50:28 -07001434
Ingo Molnar54168ed2008-08-20 09:07:45 +02001435 if (!iommu)
1436 panic("No mapping iommu for ioapic %d\n", apic);
1437
1438 index = alloc_irte(iommu, irq, 1);
1439 if (index < 0)
1440 panic("Failed to allocate IRTE for ioapic %d\n", apic);
1441
1442 memset(&irte, 0, sizeof(irte));
1443
1444 irte.present = 1;
1445 irte.dst_mode = INT_DEST_MODE;
1446 irte.trigger_mode = trigger;
1447 irte.dlvry_mode = INT_DELIVERY_MODE;
1448 irte.vector = vector;
1449 irte.dest_id = IRTE_DEST(destination);
1450
1451 modify_irte(irq, &irte);
1452
1453 ir_entry->index2 = (index >> 15) & 0x1;
1454 ir_entry->zero = 0;
1455 ir_entry->format = 1;
1456 ir_entry->index = (index & 0x7fff);
1457 } else
1458#endif
1459 {
1460 entry->delivery_mode = INT_DELIVERY_MODE;
1461 entry->dest_mode = INT_DEST_MODE;
1462 entry->dest = destination;
1463 }
1464
1465 entry->mask = 0; /* enable IRQ */
Yinghai Lu497c9a12008-08-19 20:50:28 -07001466 entry->trigger = trigger;
1467 entry->polarity = polarity;
1468 entry->vector = vector;
1469
1470 /* Mask level triggered irqs.
1471 * Use IRQ_DELAYED_DISABLE for edge triggered irqs.
1472 */
1473 if (trigger)
1474 entry->mask = 1;
Yinghai Lu497c9a12008-08-19 20:50:28 -07001475 return 0;
1476}
1477
1478static void setup_IO_APIC_irq(int apic, int pin, unsigned int irq,
Ingo Molnar54168ed2008-08-20 09:07:45 +02001479 int trigger, int polarity)
Yinghai Lu497c9a12008-08-19 20:50:28 -07001480{
1481 struct irq_cfg *cfg;
1482 struct IO_APIC_route_entry entry;
1483 cpumask_t mask;
1484
1485 if (!IO_APIC_IRQ(irq))
1486 return;
1487
1488 cfg = irq_cfg(irq);
1489
1490 mask = TARGET_CPUS;
1491 if (assign_irq_vector(irq, mask))
1492 return;
1493
1494 cpus_and(mask, cfg->domain, mask);
1495
1496 apic_printk(APIC_VERBOSE,KERN_DEBUG
1497 "IOAPIC[%d]: Set routing entry (%d-%d -> 0x%x -> "
1498 "IRQ %d Mode:%i Active:%i)\n",
1499 apic, mp_ioapics[apic].mp_apicid, pin, cfg->vector,
1500 irq, trigger, polarity);
1501
1502
1503 if (setup_ioapic_entry(mp_ioapics[apic].mp_apicid, irq, &entry,
1504 cpu_mask_to_apicid(mask), trigger, polarity,
1505 cfg->vector)) {
1506 printk("Failed to setup ioapic entry for ioapic %d, pin %d\n",
1507 mp_ioapics[apic].mp_apicid, pin);
1508 __clear_irq_vector(irq);
1509 return;
1510 }
1511
1512 ioapic_register_intr(irq, trigger);
1513 if (irq < 16)
1514 disable_8259A_irq(irq);
1515
1516 ioapic_write_entry(apic, pin, entry);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001517}
1518
1519static void __init setup_IO_APIC_irqs(void)
1520{
Cyrill Gorcunov3c2cbd22008-09-06 14:15:33 +04001521 int apic, pin, idx, irq;
1522 int notcon = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001523
1524 apic_printk(APIC_VERBOSE, KERN_DEBUG "init IO_APIC IRQs\n");
1525
1526 for (apic = 0; apic < nr_ioapics; apic++) {
Cyrill Gorcunov3c2cbd22008-09-06 14:15:33 +04001527 for (pin = 0; pin < nr_ioapic_registers[apic]; pin++) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001528
Cyrill Gorcunov3c2cbd22008-09-06 14:15:33 +04001529 idx = find_irq_entry(apic, pin, mp_INT);
1530 if (idx == -1) {
Cyrill Gorcunov2a554fb2008-09-08 19:38:06 +04001531 if (!notcon) {
Cyrill Gorcunov3c2cbd22008-09-06 14:15:33 +04001532 notcon = 1;
Cyrill Gorcunov2a554fb2008-09-08 19:38:06 +04001533 apic_printk(APIC_VERBOSE,
1534 KERN_DEBUG " %d-%d",
1535 mp_ioapics[apic].mp_apicid,
1536 pin);
1537 } else
1538 apic_printk(APIC_VERBOSE, " %d-%d",
1539 mp_ioapics[apic].mp_apicid,
1540 pin);
Cyrill Gorcunov3c2cbd22008-09-06 14:15:33 +04001541 continue;
1542 }
Yinghai Lu20d225b2007-10-17 18:04:41 +02001543
Cyrill Gorcunov3c2cbd22008-09-06 14:15:33 +04001544 irq = pin_2_irq(idx, apic, pin);
Ingo Molnar54168ed2008-08-20 09:07:45 +02001545#ifdef CONFIG_X86_32
Cyrill Gorcunov3c2cbd22008-09-06 14:15:33 +04001546 if (multi_timer_check(apic, irq))
1547 continue;
Ingo Molnar54168ed2008-08-20 09:07:45 +02001548#endif
Cyrill Gorcunov3c2cbd22008-09-06 14:15:33 +04001549 add_pin_to_irq(irq, apic, pin);
Paolo Ciarrocchi36062442008-06-08 13:07:18 +02001550
Cyrill Gorcunov3c2cbd22008-09-06 14:15:33 +04001551 setup_IO_APIC_irq(apic, pin, irq,
1552 irq_trigger(idx), irq_polarity(idx));
1553 }
1554 if (notcon) {
1555 apic_printk(APIC_VERBOSE,
Cyrill Gorcunov2a554fb2008-09-08 19:38:06 +04001556 " (apicid-pin) not connected\n");
Cyrill Gorcunov3c2cbd22008-09-06 14:15:33 +04001557 notcon = 0;
1558 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001559 }
1560
Cyrill Gorcunov3c2cbd22008-09-06 14:15:33 +04001561 if (notcon)
1562 apic_printk(APIC_VERBOSE,
Cyrill Gorcunov2a554fb2008-09-08 19:38:06 +04001563 " (apicid-pin) not connected\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001564}
1565
1566/*
Maciej W. Rozyckif7633ce2008-05-27 21:19:34 +01001567 * Set up the timer pin, possibly with the 8259A-master behind.
Linus Torvalds1da177e2005-04-16 15:20:36 -07001568 */
Maciej W. Rozyckif7633ce2008-05-27 21:19:34 +01001569static void __init setup_timer_IRQ0_pin(unsigned int apic, unsigned int pin,
1570 int vector)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001571{
1572 struct IO_APIC_route_entry entry;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001573
Ingo Molnar54168ed2008-08-20 09:07:45 +02001574#ifdef CONFIG_INTR_REMAP
1575 if (intr_remapping_enabled)
1576 return;
1577#endif
1578
Paolo Ciarrocchi36062442008-06-08 13:07:18 +02001579 memset(&entry, 0, sizeof(entry));
Linus Torvalds1da177e2005-04-16 15:20:36 -07001580
1581 /*
1582 * We use logical delivery to get the timer IRQ
1583 * to the first CPU.
1584 */
1585 entry.dest_mode = INT_DEST_MODE;
Maciej W. Rozycki03be7502008-05-27 21:19:45 +01001586 entry.mask = 1; /* mask IRQ now */
Yinghai Lud83e94a2008-08-19 20:50:33 -07001587 entry.dest = cpu_mask_to_apicid(TARGET_CPUS);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001588 entry.delivery_mode = INT_DELIVERY_MODE;
1589 entry.polarity = 0;
1590 entry.trigger = 0;
1591 entry.vector = vector;
1592
1593 /*
1594 * The timer IRQ doesn't have to know that behind the
Maciej W. Rozyckif7633ce2008-05-27 21:19:34 +01001595 * scene we may have a 8259A-master in AEOI mode ...
Linus Torvalds1da177e2005-04-16 15:20:36 -07001596 */
Ingo Molnar54168ed2008-08-20 09:07:45 +02001597 set_irq_chip_and_handler_name(0, &ioapic_chip, handle_edge_irq, "edge");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001598
1599 /*
1600 * Add it to the IO-APIC irq-routing table:
1601 */
Andi Kleencf4c6a22006-09-26 10:52:30 +02001602 ioapic_write_entry(apic, pin, entry);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001603}
1604
Maciej W. Rozycki32f71af2008-07-21 00:52:49 +01001605
1606__apicdebuginit(void) print_IO_APIC(void)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001607{
1608 int apic, i;
1609 union IO_APIC_reg_00 reg_00;
1610 union IO_APIC_reg_01 reg_01;
1611 union IO_APIC_reg_02 reg_02;
1612 union IO_APIC_reg_03 reg_03;
1613 unsigned long flags;
Yinghai Lu0f978f42008-08-19 20:50:26 -07001614 struct irq_cfg *cfg;
Yinghai Lu8f09cd22008-08-19 20:50:51 -07001615 unsigned int irq;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001616
1617 if (apic_verbosity == APIC_QUIET)
1618 return;
1619
Paolo Ciarrocchi36062442008-06-08 13:07:18 +02001620 printk(KERN_DEBUG "number of MP IRQ sources: %d.\n", mp_irq_entries);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001621 for (i = 0; i < nr_ioapics; i++)
1622 printk(KERN_DEBUG "number of IO-APIC #%d registers: %d.\n",
Alexey Starikovskiyec2cd0a2008-05-14 19:03:10 +04001623 mp_ioapics[i].mp_apicid, nr_ioapic_registers[i]);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001624
1625 /*
1626 * We are a bit conservative about what we expect. We have to
1627 * know about every hardware change ASAP.
1628 */
1629 printk(KERN_INFO "testing the IO APIC.......................\n");
1630
1631 for (apic = 0; apic < nr_ioapics; apic++) {
1632
1633 spin_lock_irqsave(&ioapic_lock, flags);
1634 reg_00.raw = io_apic_read(apic, 0);
1635 reg_01.raw = io_apic_read(apic, 1);
1636 if (reg_01.bits.version >= 0x10)
1637 reg_02.raw = io_apic_read(apic, 2);
Ingo Molnar54168ed2008-08-20 09:07:45 +02001638 if (reg_01.bits.version >= 0x20)
1639 reg_03.raw = io_apic_read(apic, 3);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001640 spin_unlock_irqrestore(&ioapic_lock, flags);
1641
Ingo Molnar54168ed2008-08-20 09:07:45 +02001642 printk("\n");
Alexey Starikovskiyec2cd0a2008-05-14 19:03:10 +04001643 printk(KERN_DEBUG "IO APIC #%d......\n", mp_ioapics[apic].mp_apicid);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001644 printk(KERN_DEBUG ".... register #00: %08X\n", reg_00.raw);
1645 printk(KERN_DEBUG "....... : physical APIC id: %02X\n", reg_00.bits.ID);
1646 printk(KERN_DEBUG "....... : Delivery Type: %X\n", reg_00.bits.delivery_type);
1647 printk(KERN_DEBUG "....... : LTS : %X\n", reg_00.bits.LTS);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001648
Ingo Molnar54168ed2008-08-20 09:07:45 +02001649 printk(KERN_DEBUG ".... register #01: %08X\n", *(int *)&reg_01);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001650 printk(KERN_DEBUG "....... : max redirection entries: %04X\n", reg_01.bits.entries);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001651
1652 printk(KERN_DEBUG "....... : PRQ implemented: %X\n", reg_01.bits.PRQ);
1653 printk(KERN_DEBUG "....... : IO APIC version: %04X\n", reg_01.bits.version);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001654
1655 /*
1656 * Some Intel chipsets with IO APIC VERSION of 0x1? don't have reg_02,
1657 * but the value of reg_02 is read as the previous read register
1658 * value, so ignore it if reg_02 == reg_01.
1659 */
1660 if (reg_01.bits.version >= 0x10 && reg_02.raw != reg_01.raw) {
1661 printk(KERN_DEBUG ".... register #02: %08X\n", reg_02.raw);
1662 printk(KERN_DEBUG "....... : arbitration: %02X\n", reg_02.bits.arbitration);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001663 }
1664
1665 /*
1666 * Some Intel chipsets with IO APIC VERSION of 0x2? don't have reg_02
1667 * or reg_03, but the value of reg_0[23] is read as the previous read
1668 * register value, so ignore it if reg_03 == reg_0[12].
1669 */
1670 if (reg_01.bits.version >= 0x20 && reg_03.raw != reg_02.raw &&
1671 reg_03.raw != reg_01.raw) {
1672 printk(KERN_DEBUG ".... register #03: %08X\n", reg_03.raw);
1673 printk(KERN_DEBUG "....... : Boot DT : %X\n", reg_03.bits.boot_DT);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001674 }
1675
1676 printk(KERN_DEBUG ".... IRQ redirection table:\n");
1677
Yinghai Lud83e94a2008-08-19 20:50:33 -07001678 printk(KERN_DEBUG " NR Dst Mask Trig IRR Pol"
1679 " Stat Dmod Deli Vect: \n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001680
1681 for (i = 0; i <= reg_01.bits.entries; i++) {
1682 struct IO_APIC_route_entry entry;
1683
Andi Kleencf4c6a22006-09-26 10:52:30 +02001684 entry = ioapic_read_entry(apic, i);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001685
Ingo Molnar54168ed2008-08-20 09:07:45 +02001686 printk(KERN_DEBUG " %02x %03X ",
1687 i,
1688 entry.dest
1689 );
Linus Torvalds1da177e2005-04-16 15:20:36 -07001690
1691 printk("%1d %1d %1d %1d %1d %1d %1d %02X\n",
1692 entry.mask,
1693 entry.trigger,
1694 entry.irr,
1695 entry.polarity,
1696 entry.delivery_status,
1697 entry.dest_mode,
1698 entry.delivery_mode,
1699 entry.vector
1700 );
1701 }
1702 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001703 printk(KERN_DEBUG "IRQ to pin mappings:\n");
Yinghai Lu8f09cd22008-08-19 20:50:51 -07001704 for_each_irq_cfg(irq, cfg) {
Yinghai Lu0f978f42008-08-19 20:50:26 -07001705 struct irq_pin_list *entry = cfg->irq_2_pin;
1706 if (!entry)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001707 continue;
Yinghai Lu8f09cd22008-08-19 20:50:51 -07001708 printk(KERN_DEBUG "IRQ%d ", irq);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001709 for (;;) {
1710 printk("-> %d:%d", entry->apic, entry->pin);
1711 if (!entry->next)
1712 break;
Yinghai Lu0f978f42008-08-19 20:50:26 -07001713 entry = entry->next;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001714 }
1715 printk("\n");
1716 }
1717
1718 printk(KERN_INFO ".................................... done.\n");
1719
1720 return;
1721}
1722
Maciej W. Rozycki32f71af2008-07-21 00:52:49 +01001723__apicdebuginit(void) print_APIC_bitfield(int base)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001724{
1725 unsigned int v;
1726 int i, j;
1727
1728 if (apic_verbosity == APIC_QUIET)
1729 return;
1730
1731 printk(KERN_DEBUG "0123456789abcdef0123456789abcdef\n" KERN_DEBUG);
1732 for (i = 0; i < 8; i++) {
1733 v = apic_read(base + i*0x10);
1734 for (j = 0; j < 32; j++) {
1735 if (v & (1<<j))
1736 printk("1");
1737 else
1738 printk("0");
1739 }
1740 printk("\n");
1741 }
1742}
1743
Maciej W. Rozycki32f71af2008-07-21 00:52:49 +01001744__apicdebuginit(void) print_local_APIC(void *dummy)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001745{
1746 unsigned int v, ver, maxlvt;
Hiroshi Shimamoto7ab6af72008-07-30 17:36:48 -07001747 u64 icr;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001748
1749 if (apic_verbosity == APIC_QUIET)
1750 return;
1751
1752 printk("\n" KERN_DEBUG "printing local APIC contents on CPU#%d/%d:\n",
1753 smp_processor_id(), hard_smp_processor_id());
Andreas Herrmann66823112008-06-05 16:35:10 +02001754 v = apic_read(APIC_ID);
Ingo Molnar54168ed2008-08-20 09:07:45 +02001755 printk(KERN_INFO "... APIC ID: %08x (%01x)\n", v, read_apic_id());
Linus Torvalds1da177e2005-04-16 15:20:36 -07001756 v = apic_read(APIC_LVR);
1757 printk(KERN_INFO "... APIC VERSION: %08x\n", v);
1758 ver = GET_APIC_VERSION(v);
Thomas Gleixnere05d7232007-02-16 01:27:58 -08001759 maxlvt = lapic_get_maxlvt();
Linus Torvalds1da177e2005-04-16 15:20:36 -07001760
1761 v = apic_read(APIC_TASKPRI);
1762 printk(KERN_DEBUG "... APIC TASKPRI: %08x (%02x)\n", v, v & APIC_TPRI_MASK);
1763
Ingo Molnar54168ed2008-08-20 09:07:45 +02001764 if (APIC_INTEGRATED(ver)) { /* !82489DX */
Yinghai Lua11b5ab2008-09-03 16:58:31 -07001765 if (!APIC_XAPIC(ver)) {
1766 v = apic_read(APIC_ARBPRI);
1767 printk(KERN_DEBUG "... APIC ARBPRI: %08x (%02x)\n", v,
1768 v & APIC_ARBPRI_MASK);
1769 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001770 v = apic_read(APIC_PROCPRI);
1771 printk(KERN_DEBUG "... APIC PROCPRI: %08x\n", v);
1772 }
1773
Yinghai Lua11b5ab2008-09-03 16:58:31 -07001774 /*
1775 * Remote read supported only in the 82489DX and local APIC for
1776 * Pentium processors.
1777 */
1778 if (!APIC_INTEGRATED(ver) || maxlvt == 3) {
1779 v = apic_read(APIC_RRR);
1780 printk(KERN_DEBUG "... APIC RRR: %08x\n", v);
1781 }
1782
Linus Torvalds1da177e2005-04-16 15:20:36 -07001783 v = apic_read(APIC_LDR);
1784 printk(KERN_DEBUG "... APIC LDR: %08x\n", v);
Yinghai Lua11b5ab2008-09-03 16:58:31 -07001785 if (!x2apic_enabled()) {
1786 v = apic_read(APIC_DFR);
1787 printk(KERN_DEBUG "... APIC DFR: %08x\n", v);
1788 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001789 v = apic_read(APIC_SPIV);
1790 printk(KERN_DEBUG "... APIC SPIV: %08x\n", v);
1791
1792 printk(KERN_DEBUG "... APIC ISR field:\n");
1793 print_APIC_bitfield(APIC_ISR);
1794 printk(KERN_DEBUG "... APIC TMR field:\n");
1795 print_APIC_bitfield(APIC_TMR);
1796 printk(KERN_DEBUG "... APIC IRR field:\n");
1797 print_APIC_bitfield(APIC_IRR);
1798
Ingo Molnar54168ed2008-08-20 09:07:45 +02001799 if (APIC_INTEGRATED(ver)) { /* !82489DX */
1800 if (maxlvt > 3) /* Due to the Pentium erratum 3AP. */
Linus Torvalds1da177e2005-04-16 15:20:36 -07001801 apic_write(APIC_ESR, 0);
Ingo Molnar54168ed2008-08-20 09:07:45 +02001802
Linus Torvalds1da177e2005-04-16 15:20:36 -07001803 v = apic_read(APIC_ESR);
1804 printk(KERN_DEBUG "... APIC ESR: %08x\n", v);
1805 }
1806
Hiroshi Shimamoto7ab6af72008-07-30 17:36:48 -07001807 icr = apic_icr_read();
Ingo Molnar0c425ce2008-08-18 13:04:26 +02001808 printk(KERN_DEBUG "... APIC ICR: %08x\n", (u32)icr);
1809 printk(KERN_DEBUG "... APIC ICR2: %08x\n", (u32)(icr >> 32));
Linus Torvalds1da177e2005-04-16 15:20:36 -07001810
1811 v = apic_read(APIC_LVTT);
1812 printk(KERN_DEBUG "... APIC LVTT: %08x\n", v);
1813
1814 if (maxlvt > 3) { /* PC is LVT#4. */
1815 v = apic_read(APIC_LVTPC);
1816 printk(KERN_DEBUG "... APIC LVTPC: %08x\n", v);
1817 }
1818 v = apic_read(APIC_LVT0);
1819 printk(KERN_DEBUG "... APIC LVT0: %08x\n", v);
1820 v = apic_read(APIC_LVT1);
1821 printk(KERN_DEBUG "... APIC LVT1: %08x\n", v);
1822
1823 if (maxlvt > 2) { /* ERR is LVT#3. */
1824 v = apic_read(APIC_LVTERR);
1825 printk(KERN_DEBUG "... APIC LVTERR: %08x\n", v);
1826 }
1827
1828 v = apic_read(APIC_TMICT);
1829 printk(KERN_DEBUG "... APIC TMICT: %08x\n", v);
1830 v = apic_read(APIC_TMCCT);
1831 printk(KERN_DEBUG "... APIC TMCCT: %08x\n", v);
1832 v = apic_read(APIC_TDCR);
1833 printk(KERN_DEBUG "... APIC TDCR: %08x\n", v);
1834 printk("\n");
1835}
1836
Maciej W. Rozycki32f71af2008-07-21 00:52:49 +01001837__apicdebuginit(void) print_all_local_APICs(void)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001838{
Yinghai Luffd5aae2008-08-19 20:50:50 -07001839 int cpu;
1840
1841 preempt_disable();
1842 for_each_online_cpu(cpu)
1843 smp_call_function_single(cpu, print_local_APIC, NULL, 1);
1844 preempt_enable();
Linus Torvalds1da177e2005-04-16 15:20:36 -07001845}
1846
Maciej W. Rozycki32f71af2008-07-21 00:52:49 +01001847__apicdebuginit(void) print_PIC(void)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001848{
Linus Torvalds1da177e2005-04-16 15:20:36 -07001849 unsigned int v;
1850 unsigned long flags;
1851
1852 if (apic_verbosity == APIC_QUIET)
1853 return;
1854
1855 printk(KERN_DEBUG "\nprinting PIC contents\n");
1856
1857 spin_lock_irqsave(&i8259A_lock, flags);
1858
1859 v = inb(0xa1) << 8 | inb(0x21);
1860 printk(KERN_DEBUG "... PIC IMR: %04x\n", v);
1861
1862 v = inb(0xa0) << 8 | inb(0x20);
1863 printk(KERN_DEBUG "... PIC IRR: %04x\n", v);
1864
Ingo Molnar54168ed2008-08-20 09:07:45 +02001865 outb(0x0b,0xa0);
1866 outb(0x0b,0x20);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001867 v = inb(0xa0) << 8 | inb(0x20);
Ingo Molnar54168ed2008-08-20 09:07:45 +02001868 outb(0x0a,0xa0);
1869 outb(0x0a,0x20);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001870
1871 spin_unlock_irqrestore(&i8259A_lock, flags);
1872
1873 printk(KERN_DEBUG "... PIC ISR: %04x\n", v);
1874
1875 v = inb(0x4d1) << 8 | inb(0x4d0);
1876 printk(KERN_DEBUG "... PIC ELCR: %04x\n", v);
1877}
1878
Maciej W. Rozycki32f71af2008-07-21 00:52:49 +01001879__apicdebuginit(int) print_all_ICs(void)
1880{
1881 print_PIC();
1882 print_all_local_APICs();
1883 print_IO_APIC();
1884
1885 return 0;
1886}
1887
1888fs_initcall(print_all_ICs);
1889
Linus Torvalds1da177e2005-04-16 15:20:36 -07001890
Yinghai Luefa25592008-08-19 20:50:36 -07001891/* Where if anywhere is the i8259 connect in external int mode */
1892static struct { int pin, apic; } ioapic_i8259 = { -1, -1 };
1893
Ingo Molnar54168ed2008-08-20 09:07:45 +02001894void __init enable_IO_APIC(void)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001895{
1896 union IO_APIC_reg_01 reg_01;
Eric W. Biedermanfcfd6362005-10-30 14:59:39 -08001897 int i8259_apic, i8259_pin;
Ingo Molnar54168ed2008-08-20 09:07:45 +02001898 int apic;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001899 unsigned long flags;
1900
Ingo Molnar54168ed2008-08-20 09:07:45 +02001901#ifdef CONFIG_X86_32
1902 int i;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001903 if (!pirqs_enabled)
1904 for (i = 0; i < MAX_PIRQS; i++)
1905 pirq_entries[i] = -1;
Ingo Molnar54168ed2008-08-20 09:07:45 +02001906#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -07001907
1908 /*
1909 * The number of IO-APIC IRQ registers (== #pins):
1910 */
Eric W. Biedermanfcfd6362005-10-30 14:59:39 -08001911 for (apic = 0; apic < nr_ioapics; apic++) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001912 spin_lock_irqsave(&ioapic_lock, flags);
Eric W. Biedermanfcfd6362005-10-30 14:59:39 -08001913 reg_01.raw = io_apic_read(apic, 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001914 spin_unlock_irqrestore(&ioapic_lock, flags);
Eric W. Biedermanfcfd6362005-10-30 14:59:39 -08001915 nr_ioapic_registers[apic] = reg_01.bits.entries+1;
1916 }
Ingo Molnar54168ed2008-08-20 09:07:45 +02001917 for(apic = 0; apic < nr_ioapics; apic++) {
Eric W. Biedermanfcfd6362005-10-30 14:59:39 -08001918 int pin;
1919 /* See if any of the pins is in ExtINT mode */
Eric W. Biederman1008fdd2006-01-11 22:46:06 +01001920 for (pin = 0; pin < nr_ioapic_registers[apic]; pin++) {
Eric W. Biedermanfcfd6362005-10-30 14:59:39 -08001921 struct IO_APIC_route_entry entry;
Andi Kleencf4c6a22006-09-26 10:52:30 +02001922 entry = ioapic_read_entry(apic, pin);
Eric W. Biedermanfcfd6362005-10-30 14:59:39 -08001923
Eric W. Biedermanfcfd6362005-10-30 14:59:39 -08001924 /* If the interrupt line is enabled and in ExtInt mode
1925 * I have found the pin where the i8259 is connected.
1926 */
1927 if ((entry.mask == 0) && (entry.delivery_mode == dest_ExtINT)) {
1928 ioapic_i8259.apic = apic;
1929 ioapic_i8259.pin = pin;
1930 goto found_i8259;
1931 }
1932 }
1933 }
1934 found_i8259:
1935 /* Look to see what if the MP table has reported the ExtINT */
1936 /* If we could not find the appropriate pin by looking at the ioapic
1937 * the i8259 probably is not connected the ioapic but give the
1938 * mptable a chance anyway.
1939 */
1940 i8259_pin = find_isa_irq_pin(0, mp_ExtINT);
1941 i8259_apic = find_isa_irq_apic(0, mp_ExtINT);
1942 /* Trust the MP table if nothing is setup in the hardware */
1943 if ((ioapic_i8259.pin == -1) && (i8259_pin >= 0)) {
1944 printk(KERN_WARNING "ExtINT not setup in hardware but reported by MP table\n");
1945 ioapic_i8259.pin = i8259_pin;
1946 ioapic_i8259.apic = i8259_apic;
1947 }
1948 /* Complain if the MP table and the hardware disagree */
1949 if (((ioapic_i8259.apic != i8259_apic) || (ioapic_i8259.pin != i8259_pin)) &&
1950 (i8259_pin >= 0) && (ioapic_i8259.pin >= 0))
1951 {
1952 printk(KERN_WARNING "ExtINT in hardware and MP table differ\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001953 }
1954
1955 /*
1956 * Do not trust the IO-APIC being empty at bootup
1957 */
1958 clear_IO_APIC();
1959}
1960
1961/*
1962 * Not an __init, needed by the reboot code
1963 */
1964void disable_IO_APIC(void)
1965{
1966 /*
1967 * Clear the IO-APIC before rebooting:
1968 */
1969 clear_IO_APIC();
1970
Eric W. Biederman650927e2005-06-25 14:57:44 -07001971 /*
Karsten Wiese0b968d22005-09-09 12:59:04 +02001972 * If the i8259 is routed through an IOAPIC
Eric W. Biederman650927e2005-06-25 14:57:44 -07001973 * Put that IOAPIC in virtual wire mode
Karsten Wiese0b968d22005-09-09 12:59:04 +02001974 * so legacy interrupts can be delivered.
Eric W. Biederman650927e2005-06-25 14:57:44 -07001975 */
Eric W. Biedermanfcfd6362005-10-30 14:59:39 -08001976 if (ioapic_i8259.pin != -1) {
Eric W. Biederman650927e2005-06-25 14:57:44 -07001977 struct IO_APIC_route_entry entry;
Eric W. Biederman650927e2005-06-25 14:57:44 -07001978
1979 memset(&entry, 0, sizeof(entry));
1980 entry.mask = 0; /* Enabled */
1981 entry.trigger = 0; /* Edge */
1982 entry.irr = 0;
1983 entry.polarity = 0; /* High */
1984 entry.delivery_status = 0;
1985 entry.dest_mode = 0; /* Physical */
Eric W. Biedermanfcfd6362005-10-30 14:59:39 -08001986 entry.delivery_mode = dest_ExtINT; /* ExtInt */
Eric W. Biederman650927e2005-06-25 14:57:44 -07001987 entry.vector = 0;
Ingo Molnar54168ed2008-08-20 09:07:45 +02001988 entry.dest = read_apic_id();
Eric W. Biederman650927e2005-06-25 14:57:44 -07001989
1990 /*
1991 * Add it to the IO-APIC irq-routing table:
1992 */
Andi Kleencf4c6a22006-09-26 10:52:30 +02001993 ioapic_write_entry(ioapic_i8259.apic, ioapic_i8259.pin, entry);
Eric W. Biederman650927e2005-06-25 14:57:44 -07001994 }
Ingo Molnar54168ed2008-08-20 09:07:45 +02001995
Eric W. Biedermanfcfd6362005-10-30 14:59:39 -08001996 disconnect_bsp_APIC(ioapic_i8259.pin != -1);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001997}
1998
Ingo Molnar54168ed2008-08-20 09:07:45 +02001999#ifdef CONFIG_X86_32
Linus Torvalds1da177e2005-04-16 15:20:36 -07002000/*
2001 * function to set the IO-APIC physical IDs based on the
2002 * values stored in the MPC table.
2003 *
2004 * by Matt Domsch <Matt_Domsch@dell.com> Tue Dec 21 12:25:05 CST 1999
2005 */
2006
Linus Torvalds1da177e2005-04-16 15:20:36 -07002007static void __init setup_ioapic_ids_from_mpc(void)
2008{
2009 union IO_APIC_reg_00 reg_00;
2010 physid_mask_t phys_id_present_map;
2011 int apic;
2012 int i;
2013 unsigned char old_id;
2014 unsigned long flags;
2015
Yinghai Lua4dbc342008-07-25 02:14:28 -07002016 if (x86_quirks->setup_ioapic_ids && x86_quirks->setup_ioapic_ids())
Yinghai Lud49c4282008-06-08 18:31:54 -07002017 return;
Yinghai Lud49c4282008-06-08 18:31:54 -07002018
Linus Torvalds1da177e2005-04-16 15:20:36 -07002019 /*
Natalie Protasevichca05fea2005-06-23 00:08:22 -07002020 * Don't check I/O APIC IDs for xAPIC systems. They have
2021 * no meaning without the serial APIC bus.
2022 */
Shaohua Li7c5c1e42006-03-23 02:59:53 -08002023 if (!(boot_cpu_data.x86_vendor == X86_VENDOR_INTEL)
2024 || APIC_XAPIC(apic_version[boot_cpu_physical_apicid]))
Natalie Protasevichca05fea2005-06-23 00:08:22 -07002025 return;
2026 /*
Linus Torvalds1da177e2005-04-16 15:20:36 -07002027 * This is broken; anything with a real cpu count has to
2028 * circumvent this idiocy regardless.
2029 */
2030 phys_id_present_map = ioapic_phys_id_map(phys_cpu_present_map);
2031
2032 /*
2033 * Set the IOAPIC ID to the value stored in the MPC table.
2034 */
2035 for (apic = 0; apic < nr_ioapics; apic++) {
2036
2037 /* Read the register 0 value */
2038 spin_lock_irqsave(&ioapic_lock, flags);
2039 reg_00.raw = io_apic_read(apic, 0);
2040 spin_unlock_irqrestore(&ioapic_lock, flags);
Paolo Ciarrocchi36062442008-06-08 13:07:18 +02002041
Alexey Starikovskiyec2cd0a2008-05-14 19:03:10 +04002042 old_id = mp_ioapics[apic].mp_apicid;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002043
Alexey Starikovskiyec2cd0a2008-05-14 19:03:10 +04002044 if (mp_ioapics[apic].mp_apicid >= get_physical_broadcast()) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002045 printk(KERN_ERR "BIOS bug, IO-APIC#%d ID is %d in the MPC table!...\n",
Alexey Starikovskiyec2cd0a2008-05-14 19:03:10 +04002046 apic, mp_ioapics[apic].mp_apicid);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002047 printk(KERN_ERR "... fixing up to %d. (tell your hw vendor)\n",
2048 reg_00.bits.ID);
Alexey Starikovskiyec2cd0a2008-05-14 19:03:10 +04002049 mp_ioapics[apic].mp_apicid = reg_00.bits.ID;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002050 }
2051
Linus Torvalds1da177e2005-04-16 15:20:36 -07002052 /*
2053 * Sanity check, is the ID really free? Every APIC in a
2054 * system must have a unique ID or we get lots of nice
2055 * 'stuck on smp_invalidate_needed IPI wait' messages.
2056 */
2057 if (check_apicid_used(phys_id_present_map,
Alexey Starikovskiyec2cd0a2008-05-14 19:03:10 +04002058 mp_ioapics[apic].mp_apicid)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002059 printk(KERN_ERR "BIOS bug, IO-APIC#%d ID %d is already used!...\n",
Alexey Starikovskiyec2cd0a2008-05-14 19:03:10 +04002060 apic, mp_ioapics[apic].mp_apicid);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002061 for (i = 0; i < get_physical_broadcast(); i++)
2062 if (!physid_isset(i, phys_id_present_map))
2063 break;
2064 if (i >= get_physical_broadcast())
2065 panic("Max APIC ID exceeded!\n");
2066 printk(KERN_ERR "... fixing up to %d. (tell your hw vendor)\n",
2067 i);
2068 physid_set(i, phys_id_present_map);
Alexey Starikovskiyec2cd0a2008-05-14 19:03:10 +04002069 mp_ioapics[apic].mp_apicid = i;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002070 } else {
2071 physid_mask_t tmp;
Alexey Starikovskiyec2cd0a2008-05-14 19:03:10 +04002072 tmp = apicid_to_cpu_present(mp_ioapics[apic].mp_apicid);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002073 apic_printk(APIC_VERBOSE, "Setting %d in the "
2074 "phys_id_present_map\n",
Alexey Starikovskiyec2cd0a2008-05-14 19:03:10 +04002075 mp_ioapics[apic].mp_apicid);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002076 physids_or(phys_id_present_map, phys_id_present_map, tmp);
2077 }
2078
2079
2080 /*
2081 * We need to adjust the IRQ routing table
2082 * if the ID changed.
2083 */
Alexey Starikovskiyec2cd0a2008-05-14 19:03:10 +04002084 if (old_id != mp_ioapics[apic].mp_apicid)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002085 for (i = 0; i < mp_irq_entries; i++)
Alexey Starikovskiy2fddb6e282008-05-14 19:03:17 +04002086 if (mp_irqs[i].mp_dstapic == old_id)
2087 mp_irqs[i].mp_dstapic
Alexey Starikovskiyec2cd0a2008-05-14 19:03:10 +04002088 = mp_ioapics[apic].mp_apicid;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002089
2090 /*
2091 * Read the right value from the MPC table and
2092 * write it into the ID register.
Paolo Ciarrocchi36062442008-06-08 13:07:18 +02002093 */
Linus Torvalds1da177e2005-04-16 15:20:36 -07002094 apic_printk(APIC_VERBOSE, KERN_INFO
2095 "...changing IO-APIC physical APIC ID to %d ...",
Alexey Starikovskiyec2cd0a2008-05-14 19:03:10 +04002096 mp_ioapics[apic].mp_apicid);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002097
Alexey Starikovskiyec2cd0a2008-05-14 19:03:10 +04002098 reg_00.bits.ID = mp_ioapics[apic].mp_apicid;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002099 spin_lock_irqsave(&ioapic_lock, flags);
Yinghai Lua2d332f2008-08-21 12:56:32 -07002100 io_apic_write(apic, 0, reg_00.raw);
2101 spin_unlock_irqrestore(&ioapic_lock, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002102
2103 /*
2104 * Sanity check
2105 */
2106 spin_lock_irqsave(&ioapic_lock, flags);
2107 reg_00.raw = io_apic_read(apic, 0);
2108 spin_unlock_irqrestore(&ioapic_lock, flags);
Alexey Starikovskiyec2cd0a2008-05-14 19:03:10 +04002109 if (reg_00.bits.ID != mp_ioapics[apic].mp_apicid)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002110 printk("could not set ID!\n");
2111 else
2112 apic_printk(APIC_VERBOSE, " ok.\n");
2113 }
2114}
Ingo Molnar54168ed2008-08-20 09:07:45 +02002115#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -07002116
Zachary Amsden7ce0bcf2007-02-13 13:26:21 +01002117int no_timer_check __initdata;
Zachary Amsden8542b202006-12-07 02:14:09 +01002118
2119static int __init notimercheck(char *s)
2120{
2121 no_timer_check = 1;
2122 return 1;
2123}
2124__setup("no_timer_check", notimercheck);
2125
Linus Torvalds1da177e2005-04-16 15:20:36 -07002126/*
2127 * There is a nasty bug in some older SMP boards, their mptable lies
2128 * about the timer IRQ. We do the following to work around the situation:
2129 *
2130 * - timer IRQ defaults to IO-APIC IRQ
2131 * - if this function detects that timer IRQs are defunct, then we fall
2132 * back to ISA timer IRQs
2133 */
Adrian Bunkf0a7a5c2007-07-21 17:10:29 +02002134static int __init timer_irq_works(void)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002135{
2136 unsigned long t1 = jiffies;
Ingo Molnar4aae0702007-12-18 18:05:58 +01002137 unsigned long flags;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002138
Zachary Amsden8542b202006-12-07 02:14:09 +01002139 if (no_timer_check)
2140 return 1;
2141
Ingo Molnar4aae0702007-12-18 18:05:58 +01002142 local_save_flags(flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002143 local_irq_enable();
2144 /* Let ten ticks pass... */
2145 mdelay((10 * 1000) / HZ);
Ingo Molnar4aae0702007-12-18 18:05:58 +01002146 local_irq_restore(flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002147
2148 /*
2149 * Expect a few ticks at least, to be sure some possible
2150 * glue logic does not lock up after one or two first
2151 * ticks in a non-ExtINT mode. Also the local APIC
2152 * might have cached one ExtINT interrupt. Finally, at
2153 * least one tick may be lost due to delays.
2154 */
Ingo Molnar54168ed2008-08-20 09:07:45 +02002155
2156 /* jiffies wrap? */
Julia Lawall1d16b532008-01-30 13:32:19 +01002157 if (time_after(jiffies, t1 + 4))
Linus Torvalds1da177e2005-04-16 15:20:36 -07002158 return 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002159 return 0;
2160}
2161
2162/*
2163 * In the SMP+IOAPIC case it might happen that there are an unspecified
2164 * number of pending IRQ events unhandled. These cases are very rare,
2165 * so we 'resend' these IRQs via IPIs, to the same CPU. It's much
2166 * better to do it this way as thus we do not have to be aware of
2167 * 'pending' interrupts in the IRQ path, except at this point.
2168 */
2169/*
2170 * Edge triggered needs to resend any interrupt
2171 * that was delayed but this is now handled in the device
2172 * independent code.
2173 */
2174
2175/*
2176 * Starting up a edge-triggered IO-APIC interrupt is
2177 * nasty - we need to make sure that we get the edge.
2178 * If it is already asserted for some reason, we need
2179 * return 1 to indicate that is was pending.
2180 *
2181 * This is not complete - we should be able to fake
2182 * an edge even if it isn't on the 8259A...
2183 */
Ingo Molnar54168ed2008-08-20 09:07:45 +02002184
Ingo Molnarf5b9ed72006-10-04 02:16:26 -07002185static unsigned int startup_ioapic_irq(unsigned int irq)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002186{
2187 int was_pending = 0;
2188 unsigned long flags;
2189
2190 spin_lock_irqsave(&ioapic_lock, flags);
2191 if (irq < 16) {
2192 disable_8259A_irq(irq);
2193 if (i8259A_irq_pending(irq))
2194 was_pending = 1;
2195 }
2196 __unmask_IO_APIC_irq(irq);
2197 spin_unlock_irqrestore(&ioapic_lock, flags);
2198
2199 return was_pending;
2200}
2201
Ingo Molnar54168ed2008-08-20 09:07:45 +02002202#ifdef CONFIG_X86_64
Eric W. Biedermanace80ab2006-10-04 02:16:47 -07002203static int ioapic_retrigger_irq(unsigned int irq)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002204{
Ingo Molnar54168ed2008-08-20 09:07:45 +02002205
2206 struct irq_cfg *cfg = irq_cfg(irq);
2207 unsigned long flags;
2208
2209 spin_lock_irqsave(&vector_lock, flags);
2210 send_IPI_mask(cpumask_of_cpu(first_cpu(cfg->domain)), cfg->vector);
2211 spin_unlock_irqrestore(&vector_lock, flags);
Ingo Molnarc0ad90a2006-06-29 02:24:44 -07002212
2213 return 1;
2214}
Ingo Molnar54168ed2008-08-20 09:07:45 +02002215#else
2216static int ioapic_retrigger_irq(unsigned int irq)
2217{
2218 send_IPI_self(irq_cfg(irq)->vector);
2219
2220 return 1;
2221}
2222#endif
2223
2224/*
2225 * Level and edge triggered IO-APIC interrupts need different handling,
2226 * so we use two separate IRQ descriptors. Edge triggered IRQs can be
2227 * handled with the level-triggered descriptor, but that one has slightly
2228 * more overhead. Level-triggered interrupts cannot be handled with the
2229 * edge-triggered handler, without risking IRQ storms and other ugly
2230 * races.
2231 */
Ingo Molnarc0ad90a2006-06-29 02:24:44 -07002232
Yinghai Lu497c9a12008-08-19 20:50:28 -07002233#ifdef CONFIG_SMP
Ingo Molnar54168ed2008-08-20 09:07:45 +02002234
2235#ifdef CONFIG_INTR_REMAP
2236static void ir_irq_migration(struct work_struct *work);
2237
2238static DECLARE_DELAYED_WORK(ir_migration_work, ir_irq_migration);
2239
2240/*
2241 * Migrate the IO-APIC irq in the presence of intr-remapping.
2242 *
2243 * For edge triggered, irq migration is a simple atomic update(of vector
2244 * and cpu destination) of IRTE and flush the hardware cache.
2245 *
2246 * For level triggered, we need to modify the io-apic RTE aswell with the update
2247 * vector information, along with modifying IRTE with vector and destination.
2248 * So irq migration for level triggered is little bit more complex compared to
2249 * edge triggered migration. But the good news is, we use the same algorithm
2250 * for level triggered migration as we have today, only difference being,
2251 * we now initiate the irq migration from process context instead of the
2252 * interrupt context.
2253 *
2254 * In future, when we do a directed EOI (combined with cpu EOI broadcast
2255 * suppression) to the IO-APIC, level triggered irq migration will also be
2256 * as simple as edge triggered migration and we can do the irq migration
2257 * with a simple atomic update to IO-APIC RTE.
2258 */
2259static void migrate_ioapic_irq(int irq, cpumask_t mask)
2260{
2261 struct irq_cfg *cfg;
2262 struct irq_desc *desc;
2263 cpumask_t tmp, cleanup_mask;
2264 struct irte irte;
2265 int modify_ioapic_rte;
2266 unsigned int dest;
2267 unsigned long flags;
2268
2269 cpus_and(tmp, mask, cpu_online_map);
2270 if (cpus_empty(tmp))
2271 return;
2272
2273 if (get_irte(irq, &irte))
2274 return;
2275
2276 if (assign_irq_vector(irq, mask))
2277 return;
2278
2279 cfg = irq_cfg(irq);
2280 cpus_and(tmp, cfg->domain, mask);
2281 dest = cpu_mask_to_apicid(tmp);
2282
2283 desc = irq_to_desc(irq);
2284 modify_ioapic_rte = desc->status & IRQ_LEVEL;
2285 if (modify_ioapic_rte) {
2286 spin_lock_irqsave(&ioapic_lock, flags);
2287 __target_IO_APIC_irq(irq, dest, cfg->vector);
2288 spin_unlock_irqrestore(&ioapic_lock, flags);
2289 }
2290
2291 irte.vector = cfg->vector;
2292 irte.dest_id = IRTE_DEST(dest);
2293
2294 /*
2295 * Modified the IRTE and flushes the Interrupt entry cache.
2296 */
2297 modify_irte(irq, &irte);
2298
2299 if (cfg->move_in_progress) {
2300 cpus_and(cleanup_mask, cfg->old_domain, cpu_online_map);
2301 cfg->move_cleanup_count = cpus_weight(cleanup_mask);
2302 send_IPI_mask(cleanup_mask, IRQ_MOVE_CLEANUP_VECTOR);
2303 cfg->move_in_progress = 0;
2304 }
2305
2306 desc->affinity = mask;
2307}
2308
2309static int migrate_irq_remapped_level(int irq)
2310{
2311 int ret = -1;
2312 struct irq_desc *desc = irq_to_desc(irq);
2313
2314 mask_IO_APIC_irq(irq);
2315
2316 if (io_apic_level_ack_pending(irq)) {
2317 /*
2318 * Interrupt in progress. Migrating irq now will change the
2319 * vector information in the IO-APIC RTE and that will confuse
2320 * the EOI broadcast performed by cpu.
2321 * So, delay the irq migration to the next instance.
2322 */
2323 schedule_delayed_work(&ir_migration_work, 1);
2324 goto unmask;
2325 }
2326
2327 /* everthing is clear. we have right of way */
2328 migrate_ioapic_irq(irq, desc->pending_mask);
2329
2330 ret = 0;
2331 desc->status &= ~IRQ_MOVE_PENDING;
2332 cpus_clear(desc->pending_mask);
2333
2334unmask:
2335 unmask_IO_APIC_irq(irq);
2336 return ret;
2337}
2338
2339static void ir_irq_migration(struct work_struct *work)
2340{
2341 unsigned int irq;
2342 struct irq_desc *desc;
2343
2344 for_each_irq_desc(irq, desc) {
2345 if (desc->status & IRQ_MOVE_PENDING) {
2346 unsigned long flags;
2347
2348 spin_lock_irqsave(&desc->lock, flags);
2349 if (!desc->chip->set_affinity ||
2350 !(desc->status & IRQ_MOVE_PENDING)) {
2351 desc->status &= ~IRQ_MOVE_PENDING;
2352 spin_unlock_irqrestore(&desc->lock, flags);
2353 continue;
2354 }
2355
2356 desc->chip->set_affinity(irq, desc->pending_mask);
2357 spin_unlock_irqrestore(&desc->lock, flags);
2358 }
2359 }
2360}
2361
2362/*
2363 * Migrates the IRQ destination in the process context.
2364 */
2365static void set_ir_ioapic_affinity_irq(unsigned int irq, cpumask_t mask)
2366{
2367 struct irq_desc *desc = irq_to_desc(irq);
2368
2369 if (desc->status & IRQ_LEVEL) {
2370 desc->status |= IRQ_MOVE_PENDING;
2371 desc->pending_mask = mask;
2372 migrate_irq_remapped_level(irq);
2373 return;
2374 }
2375
2376 migrate_ioapic_irq(irq, mask);
2377}
2378#endif
2379
Yinghai Lu497c9a12008-08-19 20:50:28 -07002380asmlinkage void smp_irq_move_cleanup_interrupt(void)
2381{
2382 unsigned vector, me;
2383 ack_APIC_irq();
Ingo Molnar54168ed2008-08-20 09:07:45 +02002384#ifdef CONFIG_X86_64
2385 exit_idle();
2386#endif
Yinghai Lu497c9a12008-08-19 20:50:28 -07002387 irq_enter();
2388
2389 me = smp_processor_id();
2390 for (vector = FIRST_EXTERNAL_VECTOR; vector < NR_VECTORS; vector++) {
2391 unsigned int irq;
2392 struct irq_desc *desc;
2393 struct irq_cfg *cfg;
2394 irq = __get_cpu_var(vector_irq)[vector];
2395
2396 desc = irq_to_desc(irq);
2397 if (!desc)
2398 continue;
2399
2400 cfg = irq_cfg(irq);
2401 spin_lock(&desc->lock);
2402 if (!cfg->move_cleanup_count)
2403 goto unlock;
2404
2405 if ((vector == cfg->vector) && cpu_isset(me, cfg->domain))
2406 goto unlock;
2407
2408 __get_cpu_var(vector_irq)[vector] = -1;
2409 cfg->move_cleanup_count--;
2410unlock:
2411 spin_unlock(&desc->lock);
2412 }
2413
2414 irq_exit();
2415}
2416
2417static void irq_complete_move(unsigned int irq)
2418{
2419 struct irq_cfg *cfg = irq_cfg(irq);
2420 unsigned vector, me;
2421
2422 if (likely(!cfg->move_in_progress))
2423 return;
2424
2425 vector = ~get_irq_regs()->orig_ax;
2426 me = smp_processor_id();
2427 if ((vector == cfg->vector) && cpu_isset(me, cfg->domain)) {
2428 cpumask_t cleanup_mask;
2429
2430 cpus_and(cleanup_mask, cfg->old_domain, cpu_online_map);
2431 cfg->move_cleanup_count = cpus_weight(cleanup_mask);
2432 send_IPI_mask(cleanup_mask, IRQ_MOVE_CLEANUP_VECTOR);
2433 cfg->move_in_progress = 0;
2434 }
2435}
2436#else
2437static inline void irq_complete_move(unsigned int irq) {}
2438#endif
Ingo Molnar54168ed2008-08-20 09:07:45 +02002439#ifdef CONFIG_INTR_REMAP
2440static void ack_x2apic_level(unsigned int irq)
2441{
2442 ack_x2APIC_irq();
2443}
2444
2445static void ack_x2apic_edge(unsigned int irq)
2446{
2447 ack_x2APIC_irq();
2448}
2449#endif
Yinghai Lu497c9a12008-08-19 20:50:28 -07002450
Yinghai Lu1d025192008-08-19 20:50:34 -07002451static void ack_apic_edge(unsigned int irq)
2452{
2453 irq_complete_move(irq);
2454 move_native_irq(irq);
2455 ack_APIC_irq();
2456}
2457
Yinghai Lu3eb2cce2008-08-19 20:50:48 -07002458#ifdef CONFIG_X86_32
2459atomic_t irq_mis_count;
2460#endif
2461
Yinghai Lu047c8fd2008-08-19 20:50:41 -07002462static void ack_apic_level(unsigned int irq)
2463{
Yinghai Lu3eb2cce2008-08-19 20:50:48 -07002464#ifdef CONFIG_X86_32
2465 unsigned long v;
2466 int i;
2467#endif
Ingo Molnar54168ed2008-08-20 09:07:45 +02002468 int do_unmask_irq = 0;
Yinghai Lu047c8fd2008-08-19 20:50:41 -07002469
Ingo Molnar54168ed2008-08-20 09:07:45 +02002470 irq_complete_move(irq);
Yinghai Lu047c8fd2008-08-19 20:50:41 -07002471#ifdef CONFIG_GENERIC_PENDING_IRQ
Ingo Molnar54168ed2008-08-20 09:07:45 +02002472 /* If we are moving the irq we need to mask it */
2473 if (unlikely(irq_to_desc(irq)->status & IRQ_MOVE_PENDING)) {
2474 do_unmask_irq = 1;
2475 mask_IO_APIC_irq(irq);
2476 }
Yinghai Lu047c8fd2008-08-19 20:50:41 -07002477#endif
2478
Yinghai Lu3eb2cce2008-08-19 20:50:48 -07002479#ifdef CONFIG_X86_32
2480 /*
2481 * It appears there is an erratum which affects at least version 0x11
2482 * of I/O APIC (that's the 82093AA and cores integrated into various
2483 * chipsets). Under certain conditions a level-triggered interrupt is
2484 * erroneously delivered as edge-triggered one but the respective IRR
2485 * bit gets set nevertheless. As a result the I/O unit expects an EOI
2486 * message but it will never arrive and further interrupts are blocked
2487 * from the source. The exact reason is so far unknown, but the
2488 * phenomenon was observed when two consecutive interrupt requests
2489 * from a given source get delivered to the same CPU and the source is
2490 * temporarily disabled in between.
2491 *
2492 * A workaround is to simulate an EOI message manually. We achieve it
2493 * by setting the trigger mode to edge and then to level when the edge
2494 * trigger mode gets detected in the TMR of a local APIC for a
2495 * level-triggered interrupt. We mask the source for the time of the
2496 * operation to prevent an edge-triggered interrupt escaping meanwhile.
2497 * The idea is from Manfred Spraul. --macro
2498 */
2499 i = irq_cfg(irq)->vector;
2500
2501 v = apic_read(APIC_TMR + ((i & ~0x1f) >> 1));
2502#endif
2503
Ingo Molnar54168ed2008-08-20 09:07:45 +02002504 /*
2505 * We must acknowledge the irq before we move it or the acknowledge will
2506 * not propagate properly.
2507 */
2508 ack_APIC_irq();
Yinghai Lu047c8fd2008-08-19 20:50:41 -07002509
Ingo Molnar54168ed2008-08-20 09:07:45 +02002510 /* Now we can move and renable the irq */
2511 if (unlikely(do_unmask_irq)) {
2512 /* Only migrate the irq if the ack has been received.
2513 *
2514 * On rare occasions the broadcast level triggered ack gets
2515 * delayed going to ioapics, and if we reprogram the
2516 * vector while Remote IRR is still set the irq will never
2517 * fire again.
2518 *
2519 * To prevent this scenario we read the Remote IRR bit
2520 * of the ioapic. This has two effects.
2521 * - On any sane system the read of the ioapic will
2522 * flush writes (and acks) going to the ioapic from
2523 * this cpu.
2524 * - We get to see if the ACK has actually been delivered.
2525 *
2526 * Based on failed experiments of reprogramming the
2527 * ioapic entry from outside of irq context starting
2528 * with masking the ioapic entry and then polling until
2529 * Remote IRR was clear before reprogramming the
2530 * ioapic I don't trust the Remote IRR bit to be
2531 * completey accurate.
2532 *
2533 * However there appears to be no other way to plug
2534 * this race, so if the Remote IRR bit is not
2535 * accurate and is causing problems then it is a hardware bug
2536 * and you can go talk to the chipset vendor about it.
2537 */
2538 if (!io_apic_level_ack_pending(irq))
2539 move_masked_irq(irq);
2540 unmask_IO_APIC_irq(irq);
2541 }
Yinghai Lu1d025192008-08-19 20:50:34 -07002542
Yinghai Lu3eb2cce2008-08-19 20:50:48 -07002543#ifdef CONFIG_X86_32
Yinghai Lu1d025192008-08-19 20:50:34 -07002544 if (!(v & (1 << (i & 0x1f)))) {
2545 atomic_inc(&irq_mis_count);
2546 spin_lock(&ioapic_lock);
2547 __mask_and_edge_IO_APIC_irq(irq);
2548 __unmask_and_level_IO_APIC_irq(irq);
2549 spin_unlock(&ioapic_lock);
2550 }
Yinghai Lu047c8fd2008-08-19 20:50:41 -07002551#endif
Yinghai Lu3eb2cce2008-08-19 20:50:48 -07002552}
Yinghai Lu1d025192008-08-19 20:50:34 -07002553
Ingo Molnarf5b9ed72006-10-04 02:16:26 -07002554static struct irq_chip ioapic_chip __read_mostly = {
2555 .name = "IO-APIC",
Eric W. Biedermanace80ab2006-10-04 02:16:47 -07002556 .startup = startup_ioapic_irq,
2557 .mask = mask_IO_APIC_irq,
2558 .unmask = unmask_IO_APIC_irq,
Yinghai Lu1d025192008-08-19 20:50:34 -07002559 .ack = ack_apic_edge,
2560 .eoi = ack_apic_level,
Ashok Raj54d5d422005-09-06 15:16:15 -07002561#ifdef CONFIG_SMP
Eric W. Biedermanace80ab2006-10-04 02:16:47 -07002562 .set_affinity = set_ioapic_affinity_irq,
Ashok Raj54d5d422005-09-06 15:16:15 -07002563#endif
Eric W. Biedermanace80ab2006-10-04 02:16:47 -07002564 .retrigger = ioapic_retrigger_irq,
Linus Torvalds1da177e2005-04-16 15:20:36 -07002565};
2566
Ingo Molnar54168ed2008-08-20 09:07:45 +02002567#ifdef CONFIG_INTR_REMAP
2568static struct irq_chip ir_ioapic_chip __read_mostly = {
2569 .name = "IR-IO-APIC",
2570 .startup = startup_ioapic_irq,
2571 .mask = mask_IO_APIC_irq,
2572 .unmask = unmask_IO_APIC_irq,
2573 .ack = ack_x2apic_edge,
2574 .eoi = ack_x2apic_level,
2575#ifdef CONFIG_SMP
2576 .set_affinity = set_ir_ioapic_affinity_irq,
2577#endif
2578 .retrigger = ioapic_retrigger_irq,
2579};
2580#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -07002581
2582static inline void init_IO_APIC_traps(void)
2583{
2584 int irq;
Yinghai Lu08678b02008-08-19 20:50:05 -07002585 struct irq_desc *desc;
Yinghai Luda51a822008-08-19 20:50:25 -07002586 struct irq_cfg *cfg;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002587
2588 /*
2589 * NOTE! The local APIC isn't very good at handling
2590 * multiple interrupts at the same interrupt level.
2591 * As the interrupt level is determined by taking the
2592 * vector number and shifting that right by 4, we
2593 * want to spread these out a bit so that they don't
2594 * all fall in the same interrupt level.
2595 *
2596 * Also, we've got to be careful not to trash gate
2597 * 0x80, because int 0x80 is hm, kind of importantish. ;)
2598 */
Yinghai Lu8f09cd22008-08-19 20:50:51 -07002599 for_each_irq_cfg(irq, cfg) {
Yinghai Luda51a822008-08-19 20:50:25 -07002600 if (IO_APIC_IRQ(irq) && !cfg->vector) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002601 /*
2602 * Hmm.. We don't have an entry for this,
2603 * so default to an old-fashioned 8259
2604 * interrupt if we can..
2605 */
2606 if (irq < 16)
2607 make_8259A_irq(irq);
Yinghai Lu08678b02008-08-19 20:50:05 -07002608 else {
2609 desc = irq_to_desc(irq);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002610 /* Strange. Oh, well.. */
Yinghai Lu08678b02008-08-19 20:50:05 -07002611 desc->chip = &no_irq_chip;
2612 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07002613 }
2614 }
2615}
2616
Ingo Molnarf5b9ed72006-10-04 02:16:26 -07002617/*
2618 * The local APIC irq-chip implementation:
2619 */
Linus Torvalds1da177e2005-04-16 15:20:36 -07002620
Paolo Ciarrocchi36062442008-06-08 13:07:18 +02002621static void mask_lapic_irq(unsigned int irq)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002622{
2623 unsigned long v;
2624
2625 v = apic_read(APIC_LVT0);
Maciej W. Rozycki593f4a72008-07-16 19:15:30 +01002626 apic_write(APIC_LVT0, v | APIC_LVT_MASKED);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002627}
2628
Paolo Ciarrocchi36062442008-06-08 13:07:18 +02002629static void unmask_lapic_irq(unsigned int irq)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002630{
Ingo Molnarf5b9ed72006-10-04 02:16:26 -07002631 unsigned long v;
2632
2633 v = apic_read(APIC_LVT0);
Maciej W. Rozycki593f4a72008-07-16 19:15:30 +01002634 apic_write(APIC_LVT0, v & ~APIC_LVT_MASKED);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002635}
2636
Ingo Molnar54168ed2008-08-20 09:07:45 +02002637static void ack_lapic_irq (unsigned int irq)
Yinghai Lu1d025192008-08-19 20:50:34 -07002638{
2639 ack_APIC_irq();
2640}
2641
Ingo Molnarf5b9ed72006-10-04 02:16:26 -07002642static struct irq_chip lapic_chip __read_mostly = {
Maciej W. Rozycki9a1c6192008-05-27 21:19:09 +01002643 .name = "local-APIC",
Ingo Molnarf5b9ed72006-10-04 02:16:26 -07002644 .mask = mask_lapic_irq,
2645 .unmask = unmask_lapic_irq,
Maciej W. Rozyckic88ac1d2008-07-11 19:35:17 +01002646 .ack = ack_lapic_irq,
Linus Torvalds1da177e2005-04-16 15:20:36 -07002647};
2648
Yinghai Lu497c9a12008-08-19 20:50:28 -07002649static void lapic_register_intr(int irq)
Maciej W. Rozyckic88ac1d2008-07-11 19:35:17 +01002650{
Yinghai Lu08678b02008-08-19 20:50:05 -07002651 struct irq_desc *desc;
2652
2653 desc = irq_to_desc(irq);
2654 desc->status &= ~IRQ_LEVEL;
Maciej W. Rozyckic88ac1d2008-07-11 19:35:17 +01002655 set_irq_chip_and_handler_name(irq, &lapic_chip, handle_edge_irq,
2656 "edge");
Maciej W. Rozyckic88ac1d2008-07-11 19:35:17 +01002657}
2658
Jan Beuliche9427102008-01-30 13:31:24 +01002659static void __init setup_nmi(void)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002660{
2661 /*
Paolo Ciarrocchi36062442008-06-08 13:07:18 +02002662 * Dirty trick to enable the NMI watchdog ...
Linus Torvalds1da177e2005-04-16 15:20:36 -07002663 * We put the 8259A master into AEOI mode and
2664 * unmask on all local APICs LVT0 as NMI.
2665 *
2666 * The idea to use the 8259A in AEOI mode ('8259A Virtual Wire')
2667 * is from Maciej W. Rozycki - so we do not have to EOI from
2668 * the NMI handler or the timer interrupt.
Paolo Ciarrocchi36062442008-06-08 13:07:18 +02002669 */
Linus Torvalds1da177e2005-04-16 15:20:36 -07002670 apic_printk(APIC_VERBOSE, KERN_INFO "activating NMI Watchdog ...");
2671
Jan Beuliche9427102008-01-30 13:31:24 +01002672 enable_NMI_through_LVT0();
Linus Torvalds1da177e2005-04-16 15:20:36 -07002673
2674 apic_printk(APIC_VERBOSE, " done.\n");
2675}
2676
2677/*
2678 * This looks a bit hackish but it's about the only one way of sending
2679 * a few INTA cycles to 8259As and any associated glue logic. ICR does
2680 * not support the ExtINT mode, unfortunately. We need to send these
2681 * cycles as some i82489DX-based boards have glue logic that keeps the
2682 * 8259A interrupt line asserted until INTA. --macro
2683 */
Jacek Luczak28acf282008-04-12 17:41:12 +02002684static inline void __init unlock_ExtINT_logic(void)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002685{
Eric W. Biedermanfcfd6362005-10-30 14:59:39 -08002686 int apic, pin, i;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002687 struct IO_APIC_route_entry entry0, entry1;
2688 unsigned char save_control, save_freq_select;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002689
Eric W. Biedermanfcfd6362005-10-30 14:59:39 -08002690 pin = find_isa_irq_pin(8, mp_INT);
Adrian Bunk956fb532006-12-07 02:14:11 +01002691 if (pin == -1) {
2692 WARN_ON_ONCE(1);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002693 return;
Adrian Bunk956fb532006-12-07 02:14:11 +01002694 }
2695 apic = find_isa_irq_apic(8, mp_INT);
2696 if (apic == -1) {
2697 WARN_ON_ONCE(1);
2698 return;
2699 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07002700
Andi Kleencf4c6a22006-09-26 10:52:30 +02002701 entry0 = ioapic_read_entry(apic, pin);
Eric W. Biedermanfcfd6362005-10-30 14:59:39 -08002702 clear_IO_APIC_pin(apic, pin);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002703
2704 memset(&entry1, 0, sizeof(entry1));
2705
2706 entry1.dest_mode = 0; /* physical delivery */
2707 entry1.mask = 0; /* unmask IRQ now */
Yinghai Lud83e94a2008-08-19 20:50:33 -07002708 entry1.dest = hard_smp_processor_id();
Linus Torvalds1da177e2005-04-16 15:20:36 -07002709 entry1.delivery_mode = dest_ExtINT;
2710 entry1.polarity = entry0.polarity;
2711 entry1.trigger = 0;
2712 entry1.vector = 0;
2713
Andi Kleencf4c6a22006-09-26 10:52:30 +02002714 ioapic_write_entry(apic, pin, entry1);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002715
2716 save_control = CMOS_READ(RTC_CONTROL);
2717 save_freq_select = CMOS_READ(RTC_FREQ_SELECT);
2718 CMOS_WRITE((save_freq_select & ~RTC_RATE_SELECT) | 0x6,
2719 RTC_FREQ_SELECT);
2720 CMOS_WRITE(save_control | RTC_PIE, RTC_CONTROL);
2721
2722 i = 100;
2723 while (i-- > 0) {
2724 mdelay(10);
2725 if ((CMOS_READ(RTC_INTR_FLAGS) & RTC_PF) == RTC_PF)
2726 i -= 10;
2727 }
2728
2729 CMOS_WRITE(save_control, RTC_CONTROL);
2730 CMOS_WRITE(save_freq_select, RTC_FREQ_SELECT);
Eric W. Biedermanfcfd6362005-10-30 14:59:39 -08002731 clear_IO_APIC_pin(apic, pin);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002732
Andi Kleencf4c6a22006-09-26 10:52:30 +02002733 ioapic_write_entry(apic, pin, entry0);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002734}
2735
Yinghai Luefa25592008-08-19 20:50:36 -07002736static int disable_timer_pin_1 __initdata;
Yinghai Lu047c8fd2008-08-19 20:50:41 -07002737/* Actually the next is obsolete, but keep it for paranoid reasons -AK */
Ingo Molnar54168ed2008-08-20 09:07:45 +02002738static int __init disable_timer_pin_setup(char *arg)
Yinghai Luefa25592008-08-19 20:50:36 -07002739{
2740 disable_timer_pin_1 = 1;
2741 return 0;
2742}
Ingo Molnar54168ed2008-08-20 09:07:45 +02002743early_param("disable_timer_pin_1", disable_timer_pin_setup);
Yinghai Luefa25592008-08-19 20:50:36 -07002744
2745int timer_through_8259 __initdata;
2746
Linus Torvalds1da177e2005-04-16 15:20:36 -07002747/*
2748 * This code may look a bit paranoid, but it's supposed to cooperate with
2749 * a wide range of boards and BIOS bugs. Fortunately only the timer IRQ
2750 * is so screwy. Thanks to Brian Perkins for testing/hacking this beast
2751 * fanatically on his truly buggy board.
Ingo Molnar54168ed2008-08-20 09:07:45 +02002752 *
2753 * FIXME: really need to revamp this for all platforms.
Linus Torvalds1da177e2005-04-16 15:20:36 -07002754 */
Zachary Amsden8542b202006-12-07 02:14:09 +01002755static inline void __init check_timer(void)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002756{
Yinghai Lu497c9a12008-08-19 20:50:28 -07002757 struct irq_cfg *cfg = irq_cfg(0);
Eric W. Biedermanfcfd6362005-10-30 14:59:39 -08002758 int apic1, pin1, apic2, pin2;
Ingo Molnar4aae0702007-12-18 18:05:58 +01002759 unsigned long flags;
Yinghai Lu047c8fd2008-08-19 20:50:41 -07002760 unsigned int ver;
2761 int no_pin1 = 0;
Ingo Molnar4aae0702007-12-18 18:05:58 +01002762
2763 local_irq_save(flags);
Maciej W. Rozyckid4d25de2007-11-26 20:42:19 +01002764
Ingo Molnar54168ed2008-08-20 09:07:45 +02002765 ver = apic_read(APIC_LVR);
2766 ver = GET_APIC_VERSION(ver);
Ingo Molnar6e908942008-03-21 14:32:36 +01002767
Linus Torvalds1da177e2005-04-16 15:20:36 -07002768 /*
2769 * get/set the timer IRQ vector:
2770 */
2771 disable_8259A_irq(0);
Yinghai Lu497c9a12008-08-19 20:50:28 -07002772 assign_irq_vector(0, TARGET_CPUS);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002773
2774 /*
Maciej W. Rozyckid11d5792008-05-21 22:09:11 +01002775 * As IRQ0 is to be enabled in the 8259A, the virtual
2776 * wire has to be disabled in the local APIC. Also
2777 * timer interrupts need to be acknowledged manually in
2778 * the 8259A for the i82489DX when using the NMI
2779 * watchdog as that APIC treats NMIs as level-triggered.
2780 * The AEOI mode will finish them in the 8259A
2781 * automatically.
Linus Torvalds1da177e2005-04-16 15:20:36 -07002782 */
Maciej W. Rozycki593f4a72008-07-16 19:15:30 +01002783 apic_write(APIC_LVT0, APIC_LVT_MASKED | APIC_DM_EXTINT);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002784 init_8259A(1);
Ingo Molnar54168ed2008-08-20 09:07:45 +02002785#ifdef CONFIG_X86_32
Maciej W. Rozyckid11d5792008-05-21 22:09:11 +01002786 timer_ack = (nmi_watchdog == NMI_IO_APIC && !APIC_INTEGRATED(ver));
Ingo Molnar54168ed2008-08-20 09:07:45 +02002787#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -07002788
Eric W. Biedermanfcfd6362005-10-30 14:59:39 -08002789 pin1 = find_isa_irq_pin(0, mp_INT);
2790 apic1 = find_isa_irq_apic(0, mp_INT);
2791 pin2 = ioapic_i8259.pin;
2792 apic2 = ioapic_i8259.apic;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002793
Maciej W. Rozycki49a66a02008-07-14 19:08:13 +01002794 apic_printk(APIC_QUIET, KERN_INFO "..TIMER: vector=0x%02X "
2795 "apic1=%d pin1=%d apic2=%d pin2=%d\n",
Yinghai Lu497c9a12008-08-19 20:50:28 -07002796 cfg->vector, apic1, pin1, apic2, pin2);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002797
Maciej W. Rozycki691874f2008-05-27 21:19:51 +01002798 /*
2799 * Some BIOS writers are clueless and report the ExtINTA
2800 * I/O APIC input from the cascaded 8259A as the timer
2801 * interrupt input. So just in case, if only one pin
2802 * was found above, try it both directly and through the
2803 * 8259A.
2804 */
2805 if (pin1 == -1) {
Ingo Molnar54168ed2008-08-20 09:07:45 +02002806#ifdef CONFIG_INTR_REMAP
2807 if (intr_remapping_enabled)
2808 panic("BIOS bug: timer not connected to IO-APIC");
2809#endif
Maciej W. Rozycki691874f2008-05-27 21:19:51 +01002810 pin1 = pin2;
2811 apic1 = apic2;
2812 no_pin1 = 1;
2813 } else if (pin2 == -1) {
2814 pin2 = pin1;
2815 apic2 = apic1;
2816 }
2817
Linus Torvalds1da177e2005-04-16 15:20:36 -07002818 if (pin1 != -1) {
2819 /*
2820 * Ok, does IRQ0 through the IOAPIC work?
2821 */
Maciej W. Rozycki691874f2008-05-27 21:19:51 +01002822 if (no_pin1) {
2823 add_pin_to_irq(0, apic1, pin1);
Yinghai Lu497c9a12008-08-19 20:50:28 -07002824 setup_timer_IRQ0_pin(apic1, pin1, cfg->vector);
Maciej W. Rozycki691874f2008-05-27 21:19:51 +01002825 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07002826 unmask_IO_APIC_irq(0);
2827 if (timer_irq_works()) {
2828 if (nmi_watchdog == NMI_IO_APIC) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002829 setup_nmi();
2830 enable_8259A_irq(0);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002831 }
Chuck Ebbert66759a02005-09-12 18:49:25 +02002832 if (disable_timer_pin_1 > 0)
2833 clear_IO_APIC_pin(0, pin1);
Ingo Molnar4aae0702007-12-18 18:05:58 +01002834 goto out;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002835 }
Ingo Molnar54168ed2008-08-20 09:07:45 +02002836#ifdef CONFIG_INTR_REMAP
2837 if (intr_remapping_enabled)
2838 panic("timer doesn't work through Interrupt-remapped IO-APIC");
2839#endif
Eric W. Biedermanfcfd6362005-10-30 14:59:39 -08002840 clear_IO_APIC_pin(apic1, pin1);
Maciej W. Rozycki691874f2008-05-27 21:19:51 +01002841 if (!no_pin1)
Maciej W. Rozycki49a66a02008-07-14 19:08:13 +01002842 apic_printk(APIC_QUIET, KERN_ERR "..MP-BIOS bug: "
2843 "8254 timer not connected to IO-APIC\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07002844
Maciej W. Rozycki49a66a02008-07-14 19:08:13 +01002845 apic_printk(APIC_QUIET, KERN_INFO "...trying to set up timer "
2846 "(IRQ0) through the 8259A ...\n");
2847 apic_printk(APIC_QUIET, KERN_INFO
2848 "..... (found apic %d pin %d) ...\n", apic2, pin2);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002849 /*
2850 * legacy devices should be connected to IO APIC #0
2851 */
Maciej W. Rozycki691874f2008-05-27 21:19:51 +01002852 replace_pin_at_irq(0, apic1, pin1, apic2, pin2);
Yinghai Lu497c9a12008-08-19 20:50:28 -07002853 setup_timer_IRQ0_pin(apic2, pin2, cfg->vector);
Maciej W. Rozycki24742ec2008-05-27 21:19:40 +01002854 unmask_IO_APIC_irq(0);
Maciej W. Rozyckiecd29472008-05-21 22:09:19 +01002855 enable_8259A_irq(0);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002856 if (timer_irq_works()) {
Maciej W. Rozycki49a66a02008-07-14 19:08:13 +01002857 apic_printk(APIC_QUIET, KERN_INFO "....... works.\n");
Maciej W. Rozycki35542c52008-05-21 22:10:22 +01002858 timer_through_8259 = 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002859 if (nmi_watchdog == NMI_IO_APIC) {
Maciej W. Rozycki60134eb2008-05-21 22:09:34 +01002860 disable_8259A_irq(0);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002861 setup_nmi();
Maciej W. Rozycki60134eb2008-05-21 22:09:34 +01002862 enable_8259A_irq(0);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002863 }
Ingo Molnar4aae0702007-12-18 18:05:58 +01002864 goto out;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002865 }
2866 /*
2867 * Cleanup, just in case ...
2868 */
Maciej W. Rozyckiecd29472008-05-21 22:09:19 +01002869 disable_8259A_irq(0);
Eric W. Biedermanfcfd6362005-10-30 14:59:39 -08002870 clear_IO_APIC_pin(apic2, pin2);
Maciej W. Rozycki49a66a02008-07-14 19:08:13 +01002871 apic_printk(APIC_QUIET, KERN_INFO "....... failed.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07002872 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07002873
2874 if (nmi_watchdog == NMI_IO_APIC) {
Maciej W. Rozycki49a66a02008-07-14 19:08:13 +01002875 apic_printk(APIC_QUIET, KERN_WARNING "timer doesn't work "
2876 "through the IO-APIC - disabling NMI Watchdog!\n");
Cyrill Gorcunov067fa0f2008-05-29 22:32:30 +04002877 nmi_watchdog = NMI_NONE;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002878 }
Ingo Molnar54168ed2008-08-20 09:07:45 +02002879#ifdef CONFIG_X86_32
Maciej W. Rozyckid11d5792008-05-21 22:09:11 +01002880 timer_ack = 0;
Ingo Molnar54168ed2008-08-20 09:07:45 +02002881#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -07002882
Maciej W. Rozycki49a66a02008-07-14 19:08:13 +01002883 apic_printk(APIC_QUIET, KERN_INFO
2884 "...trying to set up timer as Virtual Wire IRQ...\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07002885
Yinghai Lu497c9a12008-08-19 20:50:28 -07002886 lapic_register_intr(0);
2887 apic_write(APIC_LVT0, APIC_DM_FIXED | cfg->vector); /* Fixed mode */
Linus Torvalds1da177e2005-04-16 15:20:36 -07002888 enable_8259A_irq(0);
2889
2890 if (timer_irq_works()) {
Maciej W. Rozycki49a66a02008-07-14 19:08:13 +01002891 apic_printk(APIC_QUIET, KERN_INFO "..... works.\n");
Ingo Molnar4aae0702007-12-18 18:05:58 +01002892 goto out;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002893 }
Maciej W. Rozyckie67465f2008-05-21 22:09:26 +01002894 disable_8259A_irq(0);
Yinghai Lu497c9a12008-08-19 20:50:28 -07002895 apic_write(APIC_LVT0, APIC_LVT_MASKED | APIC_DM_FIXED | cfg->vector);
Maciej W. Rozycki49a66a02008-07-14 19:08:13 +01002896 apic_printk(APIC_QUIET, KERN_INFO "..... failed.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07002897
Maciej W. Rozycki49a66a02008-07-14 19:08:13 +01002898 apic_printk(APIC_QUIET, KERN_INFO
2899 "...trying to set up timer as ExtINT IRQ...\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07002900
Linus Torvalds1da177e2005-04-16 15:20:36 -07002901 init_8259A(0);
2902 make_8259A_irq(0);
Maciej W. Rozycki593f4a72008-07-16 19:15:30 +01002903 apic_write(APIC_LVT0, APIC_DM_EXTINT);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002904
2905 unlock_ExtINT_logic();
2906
2907 if (timer_irq_works()) {
Maciej W. Rozycki49a66a02008-07-14 19:08:13 +01002908 apic_printk(APIC_QUIET, KERN_INFO "..... works.\n");
Ingo Molnar4aae0702007-12-18 18:05:58 +01002909 goto out;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002910 }
Maciej W. Rozycki49a66a02008-07-14 19:08:13 +01002911 apic_printk(APIC_QUIET, KERN_INFO "..... failed :(.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07002912 panic("IO-APIC + timer doesn't work! Boot with apic=debug and send a "
Maciej W. Rozycki49a66a02008-07-14 19:08:13 +01002913 "report. Then try booting with the 'noapic' option.\n");
Ingo Molnar4aae0702007-12-18 18:05:58 +01002914out:
2915 local_irq_restore(flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002916}
2917
2918/*
Maciej W. Rozyckiaf174782008-07-11 19:35:23 +01002919 * Traditionally ISA IRQ2 is the cascade IRQ, and is not available
2920 * to devices. However there may be an I/O APIC pin available for
2921 * this interrupt regardless. The pin may be left unconnected, but
2922 * typically it will be reused as an ExtINT cascade interrupt for
2923 * the master 8259A. In the MPS case such a pin will normally be
2924 * reported as an ExtINT interrupt in the MP table. With ACPI
2925 * there is no provision for ExtINT interrupts, and in the absence
2926 * of an override it would be treated as an ordinary ISA I/O APIC
2927 * interrupt, that is edge-triggered and unmasked by default. We
2928 * used to do this, but it caused problems on some systems because
2929 * of the NMI watchdog and sometimes IRQ0 of the 8254 timer using
2930 * the same ExtINT cascade interrupt to drive the local APIC of the
2931 * bootstrap processor. Therefore we refrain from routing IRQ2 to
2932 * the I/O APIC in all cases now. No actual device should request
2933 * it anyway. --macro
Linus Torvalds1da177e2005-04-16 15:20:36 -07002934 */
2935#define PIC_IRQS (1 << PIC_CASCADE_IR)
2936
2937void __init setup_IO_APIC(void)
2938{
Ingo Molnar54168ed2008-08-20 09:07:45 +02002939
2940#ifdef CONFIG_X86_32
Linus Torvalds1da177e2005-04-16 15:20:36 -07002941 enable_IO_APIC();
Ingo Molnar54168ed2008-08-20 09:07:45 +02002942#else
2943 /*
2944 * calling enable_IO_APIC() is moved to setup_local_APIC for BP
2945 */
2946#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -07002947
Maciej W. Rozyckiaf174782008-07-11 19:35:23 +01002948 io_apic_irqs = ~PIC_IRQS;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002949
Ingo Molnar54168ed2008-08-20 09:07:45 +02002950 apic_printk(APIC_VERBOSE, "ENABLING IO-APIC IRQs\n");
2951 /*
2952 * Set up IO-APIC IRQ routing.
2953 */
2954#ifdef CONFIG_X86_32
2955 if (!acpi_ioapic)
2956 setup_ioapic_ids_from_mpc();
2957#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -07002958 sync_Arb_IDs();
2959 setup_IO_APIC_irqs();
2960 init_IO_APIC_traps();
Linus Torvalds1e4c85f2005-10-31 19:16:17 -08002961 check_timer();
Linus Torvalds1da177e2005-04-16 15:20:36 -07002962}
2963
2964/*
Ingo Molnar54168ed2008-08-20 09:07:45 +02002965 * Called after all the initialization is done. If we didnt find any
2966 * APIC bugs then we can allow the modify fast path
Linus Torvalds1da177e2005-04-16 15:20:36 -07002967 */
Paolo Ciarrocchi36062442008-06-08 13:07:18 +02002968
Linus Torvalds1da177e2005-04-16 15:20:36 -07002969static int __init io_apic_bug_finalize(void)
2970{
Ingo Molnar54168ed2008-08-20 09:07:45 +02002971 if (sis_apic_bug == -1)
2972 sis_apic_bug = 0;
2973 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002974}
2975
2976late_initcall(io_apic_bug_finalize);
2977
2978struct sysfs_ioapic_data {
2979 struct sys_device dev;
2980 struct IO_APIC_route_entry entry[0];
2981};
Ingo Molnar54168ed2008-08-20 09:07:45 +02002982static struct sysfs_ioapic_data * mp_ioapic_data[MAX_IO_APICS];
Linus Torvalds1da177e2005-04-16 15:20:36 -07002983
Pavel Machek438510f2005-04-16 15:25:24 -07002984static int ioapic_suspend(struct sys_device *dev, pm_message_t state)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002985{
2986 struct IO_APIC_route_entry *entry;
2987 struct sysfs_ioapic_data *data;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002988 int i;
Paolo Ciarrocchi36062442008-06-08 13:07:18 +02002989
Linus Torvalds1da177e2005-04-16 15:20:36 -07002990 data = container_of(dev, struct sysfs_ioapic_data, dev);
2991 entry = data->entry;
Ingo Molnar54168ed2008-08-20 09:07:45 +02002992 for (i = 0; i < nr_ioapic_registers[dev->id]; i ++, entry ++ )
2993 *entry = ioapic_read_entry(dev->id, i);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002994
2995 return 0;
2996}
2997
2998static int ioapic_resume(struct sys_device *dev)
2999{
3000 struct IO_APIC_route_entry *entry;
3001 struct sysfs_ioapic_data *data;
3002 unsigned long flags;
3003 union IO_APIC_reg_00 reg_00;
3004 int i;
Paolo Ciarrocchi36062442008-06-08 13:07:18 +02003005
Linus Torvalds1da177e2005-04-16 15:20:36 -07003006 data = container_of(dev, struct sysfs_ioapic_data, dev);
3007 entry = data->entry;
3008
3009 spin_lock_irqsave(&ioapic_lock, flags);
3010 reg_00.raw = io_apic_read(dev->id, 0);
Alexey Starikovskiyec2cd0a2008-05-14 19:03:10 +04003011 if (reg_00.bits.ID != mp_ioapics[dev->id].mp_apicid) {
3012 reg_00.bits.ID = mp_ioapics[dev->id].mp_apicid;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003013 io_apic_write(dev->id, 0, reg_00.raw);
3014 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07003015 spin_unlock_irqrestore(&ioapic_lock, flags);
Paolo Ciarrocchi36062442008-06-08 13:07:18 +02003016 for (i = 0; i < nr_ioapic_registers[dev->id]; i++)
Andi Kleencf4c6a22006-09-26 10:52:30 +02003017 ioapic_write_entry(dev->id, i, entry[i]);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003018
3019 return 0;
3020}
3021
3022static struct sysdev_class ioapic_sysdev_class = {
Kay Sieversaf5ca3f2007-12-20 02:09:39 +01003023 .name = "ioapic",
Linus Torvalds1da177e2005-04-16 15:20:36 -07003024 .suspend = ioapic_suspend,
3025 .resume = ioapic_resume,
3026};
3027
3028static int __init ioapic_init_sysfs(void)
3029{
Ingo Molnar54168ed2008-08-20 09:07:45 +02003030 struct sys_device * dev;
3031 int i, size, error;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003032
3033 error = sysdev_class_register(&ioapic_sysdev_class);
3034 if (error)
3035 return error;
3036
Ingo Molnar54168ed2008-08-20 09:07:45 +02003037 for (i = 0; i < nr_ioapics; i++ ) {
Paolo Ciarrocchi36062442008-06-08 13:07:18 +02003038 size = sizeof(struct sys_device) + nr_ioapic_registers[i]
Linus Torvalds1da177e2005-04-16 15:20:36 -07003039 * sizeof(struct IO_APIC_route_entry);
Christophe Jaillet25556c12008-06-22 22:13:48 +02003040 mp_ioapic_data[i] = kzalloc(size, GFP_KERNEL);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003041 if (!mp_ioapic_data[i]) {
3042 printk(KERN_ERR "Can't suspend/resume IOAPIC %d\n", i);
3043 continue;
3044 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07003045 dev = &mp_ioapic_data[i]->dev;
Paolo Ciarrocchi36062442008-06-08 13:07:18 +02003046 dev->id = i;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003047 dev->cls = &ioapic_sysdev_class;
3048 error = sysdev_register(dev);
3049 if (error) {
3050 kfree(mp_ioapic_data[i]);
3051 mp_ioapic_data[i] = NULL;
3052 printk(KERN_ERR "Can't suspend/resume IOAPIC %d\n", i);
3053 continue;
3054 }
3055 }
3056
3057 return 0;
3058}
3059
3060device_initcall(ioapic_init_sysfs);
3061
Eric W. Biederman3fc471e2006-10-04 02:16:39 -07003062/*
Eric W. Biederman95d77882006-10-04 02:17:01 -07003063 * Dynamic irq allocate and deallocation
Eric W. Biederman3fc471e2006-10-04 02:16:39 -07003064 */
Yinghai Lu199751d2008-08-19 20:50:27 -07003065unsigned int create_irq_nr(unsigned int irq_want)
Eric W. Biederman3fc471e2006-10-04 02:16:39 -07003066{
Eric W. Biedermanace80ab2006-10-04 02:16:47 -07003067 /* Allocate an unused irq */
Ingo Molnar54168ed2008-08-20 09:07:45 +02003068 unsigned int irq;
3069 unsigned int new;
Eric W. Biederman3fc471e2006-10-04 02:16:39 -07003070 unsigned long flags;
Yinghai Luda51a822008-08-19 20:50:25 -07003071 struct irq_cfg *cfg_new;
Eric W. Biederman3fc471e2006-10-04 02:16:39 -07003072
Yinghai Lu497c9a12008-08-19 20:50:28 -07003073#ifndef CONFIG_HAVE_SPARSE_IRQ
Yinghai Lu199751d2008-08-19 20:50:27 -07003074 irq_want = nr_irqs - 1;
Yinghai Lu497c9a12008-08-19 20:50:28 -07003075#endif
Yinghai Lu199751d2008-08-19 20:50:27 -07003076
3077 irq = 0;
Eric W. Biedermanace80ab2006-10-04 02:16:47 -07003078 spin_lock_irqsave(&vector_lock, flags);
Ingo Molnar54168ed2008-08-20 09:07:45 +02003079 for (new = irq_want; new > 0; new--) {
Eric W. Biedermanace80ab2006-10-04 02:16:47 -07003080 if (platform_legacy_irq(new))
3081 continue;
Yinghai Luda51a822008-08-19 20:50:25 -07003082 cfg_new = irq_cfg(new);
3083 if (cfg_new && cfg_new->vector != 0)
Eric W. Biedermanace80ab2006-10-04 02:16:47 -07003084 continue;
Yinghai Lu047c8fd2008-08-19 20:50:41 -07003085 /* check if need to create one */
Yinghai Luda51a822008-08-19 20:50:25 -07003086 if (!cfg_new)
3087 cfg_new = irq_cfg_alloc(new);
Yinghai Lu497c9a12008-08-19 20:50:28 -07003088 if (__assign_irq_vector(new, TARGET_CPUS) == 0)
Eric W. Biedermanace80ab2006-10-04 02:16:47 -07003089 irq = new;
3090 break;
3091 }
3092 spin_unlock_irqrestore(&vector_lock, flags);
Eric W. Biederman3fc471e2006-10-04 02:16:39 -07003093
Yinghai Lu199751d2008-08-19 20:50:27 -07003094 if (irq > 0) {
Eric W. Biederman3fc471e2006-10-04 02:16:39 -07003095 dynamic_irq_init(irq);
3096 }
3097 return irq;
3098}
3099
Yinghai Lu199751d2008-08-19 20:50:27 -07003100int create_irq(void)
3101{
Ingo Molnar54168ed2008-08-20 09:07:45 +02003102 int irq;
3103
3104 irq = create_irq_nr(nr_irqs - 1);
3105
3106 if (irq == 0)
3107 irq = -1;
3108
3109 return irq;
Yinghai Lu199751d2008-08-19 20:50:27 -07003110}
3111
Eric W. Biederman3fc471e2006-10-04 02:16:39 -07003112void destroy_irq(unsigned int irq)
3113{
3114 unsigned long flags;
Eric W. Biederman3fc471e2006-10-04 02:16:39 -07003115
3116 dynamic_irq_cleanup(irq);
3117
Ingo Molnar54168ed2008-08-20 09:07:45 +02003118#ifdef CONFIG_INTR_REMAP
3119 free_irte(irq);
3120#endif
Eric W. Biederman3fc471e2006-10-04 02:16:39 -07003121 spin_lock_irqsave(&vector_lock, flags);
Yinghai Lu497c9a12008-08-19 20:50:28 -07003122 __clear_irq_vector(irq);
Eric W. Biederman3fc471e2006-10-04 02:16:39 -07003123 spin_unlock_irqrestore(&vector_lock, flags);
3124}
Eric W. Biederman3fc471e2006-10-04 02:16:39 -07003125
Eric W. Biederman2d3fcc12006-10-04 02:16:43 -07003126/*
Simon Arlott27b46d72007-10-20 01:13:56 +02003127 * MSI message composition
Eric W. Biederman2d3fcc12006-10-04 02:16:43 -07003128 */
3129#ifdef CONFIG_PCI_MSI
Eric W. Biederman3b7d1922006-10-04 02:16:59 -07003130static int msi_compose_msg(struct pci_dev *pdev, unsigned int irq, struct msi_msg *msg)
Eric W. Biederman2d3fcc12006-10-04 02:16:43 -07003131{
Yinghai Lu497c9a12008-08-19 20:50:28 -07003132 struct irq_cfg *cfg;
3133 int err;
Eric W. Biederman2d3fcc12006-10-04 02:16:43 -07003134 unsigned dest;
Yinghai Lu497c9a12008-08-19 20:50:28 -07003135 cpumask_t tmp;
Eric W. Biederman2d3fcc12006-10-04 02:16:43 -07003136
Yinghai Lu497c9a12008-08-19 20:50:28 -07003137 tmp = TARGET_CPUS;
3138 err = assign_irq_vector(irq, tmp);
3139 if (err)
3140 return err;
Eric W. Biederman2d3fcc12006-10-04 02:16:43 -07003141
Yinghai Lu497c9a12008-08-19 20:50:28 -07003142 cfg = irq_cfg(irq);
3143 cpus_and(tmp, cfg->domain, tmp);
3144 dest = cpu_mask_to_apicid(tmp);
Eric W. Biederman2d3fcc12006-10-04 02:16:43 -07003145
Ingo Molnar54168ed2008-08-20 09:07:45 +02003146#ifdef CONFIG_INTR_REMAP
3147 if (irq_remapped(irq)) {
3148 struct irte irte;
3149 int ir_index;
3150 u16 sub_handle;
Yinghai Lu497c9a12008-08-19 20:50:28 -07003151
Ingo Molnar54168ed2008-08-20 09:07:45 +02003152 ir_index = map_irq_to_irte_handle(irq, &sub_handle);
3153 BUG_ON(ir_index == -1);
Yinghai Lu497c9a12008-08-19 20:50:28 -07003154
Ingo Molnar54168ed2008-08-20 09:07:45 +02003155 memset (&irte, 0, sizeof(irte));
3156
3157 irte.present = 1;
3158 irte.dst_mode = INT_DEST_MODE;
3159 irte.trigger_mode = 0; /* edge */
3160 irte.dlvry_mode = INT_DELIVERY_MODE;
3161 irte.vector = cfg->vector;
3162 irte.dest_id = IRTE_DEST(dest);
3163
3164 modify_irte(irq, &irte);
3165
3166 msg->address_hi = MSI_ADDR_BASE_HI;
3167 msg->data = sub_handle;
3168 msg->address_lo = MSI_ADDR_BASE_LO | MSI_ADDR_IR_EXT_INT |
3169 MSI_ADDR_IR_SHV |
3170 MSI_ADDR_IR_INDEX1(ir_index) |
3171 MSI_ADDR_IR_INDEX2(ir_index);
3172 } else
3173#endif
3174 {
3175 msg->address_hi = MSI_ADDR_BASE_HI;
3176 msg->address_lo =
3177 MSI_ADDR_BASE_LO |
3178 ((INT_DEST_MODE == 0) ?
3179 MSI_ADDR_DEST_MODE_PHYSICAL:
3180 MSI_ADDR_DEST_MODE_LOGICAL) |
3181 ((INT_DELIVERY_MODE != dest_LowestPrio) ?
3182 MSI_ADDR_REDIRECTION_CPU:
3183 MSI_ADDR_REDIRECTION_LOWPRI) |
3184 MSI_ADDR_DEST_ID(dest);
3185
3186 msg->data =
3187 MSI_DATA_TRIGGER_EDGE |
3188 MSI_DATA_LEVEL_ASSERT |
3189 ((INT_DELIVERY_MODE != dest_LowestPrio) ?
3190 MSI_DATA_DELIVERY_FIXED:
3191 MSI_DATA_DELIVERY_LOWPRI) |
3192 MSI_DATA_VECTOR(cfg->vector);
3193 }
Yinghai Lu497c9a12008-08-19 20:50:28 -07003194 return err;
Eric W. Biederman2d3fcc12006-10-04 02:16:43 -07003195}
3196
Eric W. Biederman3b7d1922006-10-04 02:16:59 -07003197#ifdef CONFIG_SMP
3198static void set_msi_irq_affinity(unsigned int irq, cpumask_t mask)
3199{
Yinghai Lu497c9a12008-08-19 20:50:28 -07003200 struct irq_cfg *cfg;
Eric W. Biederman3b7d1922006-10-04 02:16:59 -07003201 struct msi_msg msg;
3202 unsigned int dest;
3203 cpumask_t tmp;
Ingo Molnar54168ed2008-08-20 09:07:45 +02003204 struct irq_desc *desc;
Eric W. Biederman3b7d1922006-10-04 02:16:59 -07003205
3206 cpus_and(tmp, mask, cpu_online_map);
3207 if (cpus_empty(tmp))
Eric W. Biederman3b7d1922006-10-04 02:16:59 -07003208 return;
3209
Yinghai Lu497c9a12008-08-19 20:50:28 -07003210 if (assign_irq_vector(irq, mask))
3211 return;
3212
3213 cfg = irq_cfg(irq);
3214 cpus_and(tmp, cfg->domain, mask);
3215 dest = cpu_mask_to_apicid(tmp);
Eric W. Biederman3b7d1922006-10-04 02:16:59 -07003216
3217 read_msi_msg(irq, &msg);
3218
3219 msg.data &= ~MSI_DATA_VECTOR_MASK;
Yinghai Lu497c9a12008-08-19 20:50:28 -07003220 msg.data |= MSI_DATA_VECTOR(cfg->vector);
Eric W. Biederman3b7d1922006-10-04 02:16:59 -07003221 msg.address_lo &= ~MSI_ADDR_DEST_ID_MASK;
3222 msg.address_lo |= MSI_ADDR_DEST_ID(dest);
3223
3224 write_msi_msg(irq, &msg);
Ingo Molnar54168ed2008-08-20 09:07:45 +02003225 desc = irq_to_desc(irq);
3226 desc->affinity = mask;
Eric W. Biederman3b7d1922006-10-04 02:16:59 -07003227}
Ingo Molnar54168ed2008-08-20 09:07:45 +02003228
3229#ifdef CONFIG_INTR_REMAP
3230/*
3231 * Migrate the MSI irq to another cpumask. This migration is
3232 * done in the process context using interrupt-remapping hardware.
3233 */
3234static void ir_set_msi_irq_affinity(unsigned int irq, cpumask_t mask)
3235{
3236 struct irq_cfg *cfg;
3237 unsigned int dest;
3238 cpumask_t tmp, cleanup_mask;
3239 struct irte irte;
3240 struct irq_desc *desc;
3241
3242 cpus_and(tmp, mask, cpu_online_map);
3243 if (cpus_empty(tmp))
3244 return;
3245
3246 if (get_irte(irq, &irte))
3247 return;
3248
3249 if (assign_irq_vector(irq, mask))
3250 return;
3251
3252 cfg = irq_cfg(irq);
3253 cpus_and(tmp, cfg->domain, mask);
3254 dest = cpu_mask_to_apicid(tmp);
3255
3256 irte.vector = cfg->vector;
3257 irte.dest_id = IRTE_DEST(dest);
3258
3259 /*
3260 * atomically update the IRTE with the new destination and vector.
3261 */
3262 modify_irte(irq, &irte);
3263
3264 /*
3265 * After this point, all the interrupts will start arriving
3266 * at the new destination. So, time to cleanup the previous
3267 * vector allocation.
3268 */
3269 if (cfg->move_in_progress) {
3270 cpus_and(cleanup_mask, cfg->old_domain, cpu_online_map);
3271 cfg->move_cleanup_count = cpus_weight(cleanup_mask);
3272 send_IPI_mask(cleanup_mask, IRQ_MOVE_CLEANUP_VECTOR);
3273 cfg->move_in_progress = 0;
3274 }
3275
3276 desc = irq_to_desc(irq);
3277 desc->affinity = mask;
3278}
3279#endif
Eric W. Biederman3b7d1922006-10-04 02:16:59 -07003280#endif /* CONFIG_SMP */
3281
3282/*
3283 * IRQ Chip for MSI PCI/PCI-X/PCI-Express Devices,
3284 * which implement the MSI or MSI-X Capability Structure.
3285 */
3286static struct irq_chip msi_chip = {
3287 .name = "PCI-MSI",
3288 .unmask = unmask_msi_irq,
3289 .mask = mask_msi_irq,
Yinghai Lu1d025192008-08-19 20:50:34 -07003290 .ack = ack_apic_edge,
Eric W. Biederman3b7d1922006-10-04 02:16:59 -07003291#ifdef CONFIG_SMP
3292 .set_affinity = set_msi_irq_affinity,
3293#endif
3294 .retrigger = ioapic_retrigger_irq,
3295};
3296
Ingo Molnar54168ed2008-08-20 09:07:45 +02003297#ifdef CONFIG_INTR_REMAP
3298static struct irq_chip msi_ir_chip = {
3299 .name = "IR-PCI-MSI",
3300 .unmask = unmask_msi_irq,
3301 .mask = mask_msi_irq,
3302 .ack = ack_x2apic_edge,
3303#ifdef CONFIG_SMP
3304 .set_affinity = ir_set_msi_irq_affinity,
3305#endif
3306 .retrigger = ioapic_retrigger_irq,
3307};
3308
3309/*
3310 * Map the PCI dev to the corresponding remapping hardware unit
3311 * and allocate 'nvec' consecutive interrupt-remapping table entries
3312 * in it.
3313 */
3314static int msi_alloc_irte(struct pci_dev *dev, int irq, int nvec)
3315{
3316 struct intel_iommu *iommu;
3317 int index;
3318
3319 iommu = map_dev_to_ir(dev);
3320 if (!iommu) {
3321 printk(KERN_ERR
3322 "Unable to map PCI %s to iommu\n", pci_name(dev));
3323 return -ENOENT;
3324 }
3325
3326 index = alloc_irte(iommu, irq, nvec);
3327 if (index < 0) {
3328 printk(KERN_ERR
3329 "Unable to allocate %d IRTE for PCI %s\n", nvec,
3330 pci_name(dev));
3331 return -ENOSPC;
3332 }
3333 return index;
3334}
3335#endif
Yinghai Lu1d025192008-08-19 20:50:34 -07003336
3337static int setup_msi_irq(struct pci_dev *dev, struct msi_desc *desc, int irq)
3338{
3339 int ret;
3340 struct msi_msg msg;
3341
3342 ret = msi_compose_msg(dev, irq, &msg);
3343 if (ret < 0)
3344 return ret;
3345
3346 set_irq_msi(irq, desc);
3347 write_msi_msg(irq, &msg);
3348
Ingo Molnar54168ed2008-08-20 09:07:45 +02003349#ifdef CONFIG_INTR_REMAP
3350 if (irq_remapped(irq)) {
3351 struct irq_desc *desc = irq_to_desc(irq);
3352 /*
3353 * irq migration in process context
3354 */
3355 desc->status |= IRQ_MOVE_PCNTXT;
3356 set_irq_chip_and_handler_name(irq, &msi_ir_chip, handle_edge_irq, "edge");
3357 } else
3358#endif
3359 set_irq_chip_and_handler_name(irq, &msi_chip, handle_edge_irq, "edge");
Yinghai Lu1d025192008-08-19 20:50:34 -07003360
3361 return 0;
3362}
3363
Yinghai Lu199751d2008-08-19 20:50:27 -07003364static unsigned int build_irq_for_pci_dev(struct pci_dev *dev)
3365{
3366 unsigned int irq;
3367
3368 irq = dev->bus->number;
3369 irq <<= 8;
3370 irq |= dev->devfn;
3371 irq <<= 12;
3372
3373 return irq;
3374}
3375
Eric W. Biedermanf7feaca2007-01-28 12:56:37 -07003376int arch_setup_msi_irq(struct pci_dev *dev, struct msi_desc *desc)
Eric W. Biederman3b7d1922006-10-04 02:16:59 -07003377{
Ingo Molnar54168ed2008-08-20 09:07:45 +02003378 unsigned int irq;
3379 int ret;
Yinghai Lu199751d2008-08-19 20:50:27 -07003380 unsigned int irq_want;
3381
3382 irq_want = build_irq_for_pci_dev(dev) + 0x100;
3383
3384 irq = create_irq_nr(irq_want);
Yinghai Lu199751d2008-08-19 20:50:27 -07003385 if (irq == 0)
3386 return -1;
Eric W. Biedermanf7feaca2007-01-28 12:56:37 -07003387
Ingo Molnar54168ed2008-08-20 09:07:45 +02003388#ifdef CONFIG_INTR_REMAP
3389 if (!intr_remapping_enabled)
3390 goto no_ir;
3391
3392 ret = msi_alloc_irte(dev, irq, 1);
3393 if (ret < 0)
3394 goto error;
3395no_ir:
3396#endif
Yinghai Lu1d025192008-08-19 20:50:34 -07003397 ret = setup_msi_irq(dev, desc, irq);
Eric W. Biedermanf7feaca2007-01-28 12:56:37 -07003398 if (ret < 0) {
3399 destroy_irq(irq);
Eric W. Biederman3b7d1922006-10-04 02:16:59 -07003400 return ret;
Ingo Molnar54168ed2008-08-20 09:07:45 +02003401 }
Michael Ellerman7fe37302007-04-18 19:39:21 +10003402 return 0;
Ingo Molnar54168ed2008-08-20 09:07:45 +02003403
3404#ifdef CONFIG_INTR_REMAP
3405error:
3406 destroy_irq(irq);
3407 return ret;
3408#endif
Eric W. Biederman3b7d1922006-10-04 02:16:59 -07003409}
3410
Yinghai Lu047c8fd2008-08-19 20:50:41 -07003411int arch_setup_msi_irqs(struct pci_dev *dev, int nvec, int type)
3412{
Ingo Molnar54168ed2008-08-20 09:07:45 +02003413 unsigned int irq;
3414 int ret, sub_handle;
3415 struct msi_desc *desc;
3416 unsigned int irq_want;
Yinghai Lu047c8fd2008-08-19 20:50:41 -07003417
Ingo Molnar54168ed2008-08-20 09:07:45 +02003418#ifdef CONFIG_INTR_REMAP
3419 struct intel_iommu *iommu = 0;
3420 int index = 0;
3421#endif
3422
3423 irq_want = build_irq_for_pci_dev(dev) + 0x100;
3424 sub_handle = 0;
3425 list_for_each_entry(desc, &dev->msi_list, list) {
3426 irq = create_irq_nr(irq_want--);
3427 if (irq == 0)
3428 return -1;
3429#ifdef CONFIG_INTR_REMAP
3430 if (!intr_remapping_enabled)
3431 goto no_ir;
3432
3433 if (!sub_handle) {
3434 /*
3435 * allocate the consecutive block of IRTE's
3436 * for 'nvec'
3437 */
3438 index = msi_alloc_irte(dev, irq, nvec);
3439 if (index < 0) {
3440 ret = index;
3441 goto error;
3442 }
3443 } else {
3444 iommu = map_dev_to_ir(dev);
3445 if (!iommu) {
3446 ret = -ENOENT;
3447 goto error;
3448 }
3449 /*
3450 * setup the mapping between the irq and the IRTE
3451 * base index, the sub_handle pointing to the
3452 * appropriate interrupt remap table entry.
3453 */
3454 set_irte_irq(irq, iommu, index, sub_handle);
3455 }
3456no_ir:
3457#endif
3458 ret = setup_msi_irq(dev, desc, irq);
3459 if (ret < 0)
3460 goto error;
3461 sub_handle++;
3462 }
3463 return 0;
Yinghai Lu047c8fd2008-08-19 20:50:41 -07003464
3465error:
Ingo Molnar54168ed2008-08-20 09:07:45 +02003466 destroy_irq(irq);
3467 return ret;
Yinghai Lu047c8fd2008-08-19 20:50:41 -07003468}
3469
Eric W. Biederman3b7d1922006-10-04 02:16:59 -07003470void arch_teardown_msi_irq(unsigned int irq)
Eric W. Biederman2d3fcc12006-10-04 02:16:43 -07003471{
Eric W. Biedermanf7feaca2007-01-28 12:56:37 -07003472 destroy_irq(irq);
Eric W. Biederman2d3fcc12006-10-04 02:16:43 -07003473}
3474
Ingo Molnar54168ed2008-08-20 09:07:45 +02003475#ifdef CONFIG_DMAR
3476#ifdef CONFIG_SMP
3477static void dmar_msi_set_affinity(unsigned int irq, cpumask_t mask)
3478{
3479 struct irq_cfg *cfg;
3480 struct msi_msg msg;
3481 unsigned int dest;
3482 cpumask_t tmp;
3483 struct irq_desc *desc;
Eric W. Biederman2d3fcc12006-10-04 02:16:43 -07003484
Ingo Molnar54168ed2008-08-20 09:07:45 +02003485 cpus_and(tmp, mask, cpu_online_map);
3486 if (cpus_empty(tmp))
3487 return;
3488
3489 if (assign_irq_vector(irq, mask))
3490 return;
3491
3492 cfg = irq_cfg(irq);
3493 cpus_and(tmp, cfg->domain, mask);
3494 dest = cpu_mask_to_apicid(tmp);
3495
3496 dmar_msi_read(irq, &msg);
3497
3498 msg.data &= ~MSI_DATA_VECTOR_MASK;
3499 msg.data |= MSI_DATA_VECTOR(cfg->vector);
3500 msg.address_lo &= ~MSI_ADDR_DEST_ID_MASK;
3501 msg.address_lo |= MSI_ADDR_DEST_ID(dest);
3502
3503 dmar_msi_write(irq, &msg);
3504 desc = irq_to_desc(irq);
3505 desc->affinity = mask;
3506}
3507#endif /* CONFIG_SMP */
3508
3509struct irq_chip dmar_msi_type = {
3510 .name = "DMAR_MSI",
3511 .unmask = dmar_msi_unmask,
3512 .mask = dmar_msi_mask,
3513 .ack = ack_apic_edge,
3514#ifdef CONFIG_SMP
3515 .set_affinity = dmar_msi_set_affinity,
3516#endif
3517 .retrigger = ioapic_retrigger_irq,
3518};
3519
3520int arch_setup_dmar_msi(unsigned int irq)
3521{
3522 int ret;
3523 struct msi_msg msg;
3524
3525 ret = msi_compose_msg(NULL, irq, &msg);
3526 if (ret < 0)
3527 return ret;
3528 dmar_msi_write(irq, &msg);
3529 set_irq_chip_and_handler_name(irq, &dmar_msi_type, handle_edge_irq,
3530 "edge");
3531 return 0;
3532}
3533#endif
3534
venkatesh.pallipadi@intel.com58ac1e72008-09-05 18:02:17 -07003535#ifdef CONFIG_HPET_TIMER
3536
3537#ifdef CONFIG_SMP
3538static void hpet_msi_set_affinity(unsigned int irq, cpumask_t mask)
3539{
3540 struct irq_cfg *cfg;
3541 struct irq_desc *desc;
3542 struct msi_msg msg;
3543 unsigned int dest;
3544 cpumask_t tmp;
3545
3546 cpus_and(tmp, mask, cpu_online_map);
3547 if (cpus_empty(tmp))
3548 return;
3549
3550 if (assign_irq_vector(irq, mask))
3551 return;
3552
3553 cfg = irq_cfg(irq);
3554 cpus_and(tmp, cfg->domain, mask);
3555 dest = cpu_mask_to_apicid(tmp);
3556
3557 hpet_msi_read(irq, &msg);
3558
3559 msg.data &= ~MSI_DATA_VECTOR_MASK;
3560 msg.data |= MSI_DATA_VECTOR(cfg->vector);
3561 msg.address_lo &= ~MSI_ADDR_DEST_ID_MASK;
3562 msg.address_lo |= MSI_ADDR_DEST_ID(dest);
3563
3564 hpet_msi_write(irq, &msg);
3565 desc = irq_to_desc(irq);
3566 desc->affinity = mask;
3567}
3568#endif /* CONFIG_SMP */
3569
3570struct irq_chip hpet_msi_type = {
3571 .name = "HPET_MSI",
3572 .unmask = hpet_msi_unmask,
3573 .mask = hpet_msi_mask,
3574 .ack = ack_apic_edge,
3575#ifdef CONFIG_SMP
3576 .set_affinity = hpet_msi_set_affinity,
3577#endif
3578 .retrigger = ioapic_retrigger_irq,
3579};
3580
3581int arch_setup_hpet_msi(unsigned int irq)
3582{
3583 int ret;
3584 struct msi_msg msg;
3585
3586 ret = msi_compose_msg(NULL, irq, &msg);
3587 if (ret < 0)
3588 return ret;
3589
3590 hpet_msi_write(irq, &msg);
3591 set_irq_chip_and_handler_name(irq, &hpet_msi_type, handle_edge_irq,
3592 "edge");
3593 return 0;
3594}
3595#endif
3596
Ingo Molnar54168ed2008-08-20 09:07:45 +02003597#endif /* CONFIG_PCI_MSI */
Eric W. Biederman8b955b02006-10-04 02:16:55 -07003598/*
3599 * Hypertransport interrupt support
3600 */
3601#ifdef CONFIG_HT_IRQ
3602
3603#ifdef CONFIG_SMP
3604
Yinghai Lu497c9a12008-08-19 20:50:28 -07003605static void target_ht_irq(unsigned int irq, unsigned int dest, u8 vector)
Eric W. Biederman8b955b02006-10-04 02:16:55 -07003606{
Eric W. Biedermanec683072006-11-08 17:44:57 -08003607 struct ht_irq_msg msg;
3608 fetch_ht_irq_msg(irq, &msg);
Eric W. Biederman8b955b02006-10-04 02:16:55 -07003609
Yinghai Lu497c9a12008-08-19 20:50:28 -07003610 msg.address_lo &= ~(HT_IRQ_LOW_VECTOR_MASK | HT_IRQ_LOW_DEST_ID_MASK);
Eric W. Biedermanec683072006-11-08 17:44:57 -08003611 msg.address_hi &= ~(HT_IRQ_HIGH_DEST_ID_MASK);
Eric W. Biederman8b955b02006-10-04 02:16:55 -07003612
Yinghai Lu497c9a12008-08-19 20:50:28 -07003613 msg.address_lo |= HT_IRQ_LOW_VECTOR(vector) | HT_IRQ_LOW_DEST_ID(dest);
Eric W. Biedermanec683072006-11-08 17:44:57 -08003614 msg.address_hi |= HT_IRQ_HIGH_DEST_ID(dest);
Eric W. Biederman8b955b02006-10-04 02:16:55 -07003615
Eric W. Biedermanec683072006-11-08 17:44:57 -08003616 write_ht_irq_msg(irq, &msg);
Eric W. Biederman8b955b02006-10-04 02:16:55 -07003617}
3618
3619static void set_ht_irq_affinity(unsigned int irq, cpumask_t mask)
3620{
Yinghai Lu497c9a12008-08-19 20:50:28 -07003621 struct irq_cfg *cfg;
Eric W. Biederman8b955b02006-10-04 02:16:55 -07003622 unsigned int dest;
3623 cpumask_t tmp;
Ingo Molnar54168ed2008-08-20 09:07:45 +02003624 struct irq_desc *desc;
Eric W. Biederman8b955b02006-10-04 02:16:55 -07003625
3626 cpus_and(tmp, mask, cpu_online_map);
3627 if (cpus_empty(tmp))
Yinghai Lu497c9a12008-08-19 20:50:28 -07003628 return;
Eric W. Biederman8b955b02006-10-04 02:16:55 -07003629
Yinghai Lu497c9a12008-08-19 20:50:28 -07003630 if (assign_irq_vector(irq, mask))
3631 return;
Eric W. Biederman8b955b02006-10-04 02:16:55 -07003632
Yinghai Lu497c9a12008-08-19 20:50:28 -07003633 cfg = irq_cfg(irq);
3634 cpus_and(tmp, cfg->domain, mask);
3635 dest = cpu_mask_to_apicid(tmp);
Eric W. Biederman8b955b02006-10-04 02:16:55 -07003636
Yinghai Lu497c9a12008-08-19 20:50:28 -07003637 target_ht_irq(irq, dest, cfg->vector);
Ingo Molnar54168ed2008-08-20 09:07:45 +02003638 desc = irq_to_desc(irq);
3639 desc->affinity = mask;
Eric W. Biederman8b955b02006-10-04 02:16:55 -07003640}
3641#endif
3642
Aneesh Kumar K.Vc37e1082006-10-11 01:20:43 -07003643static struct irq_chip ht_irq_chip = {
Eric W. Biederman8b955b02006-10-04 02:16:55 -07003644 .name = "PCI-HT",
3645 .mask = mask_ht_irq,
3646 .unmask = unmask_ht_irq,
Yinghai Lu1d025192008-08-19 20:50:34 -07003647 .ack = ack_apic_edge,
Eric W. Biederman8b955b02006-10-04 02:16:55 -07003648#ifdef CONFIG_SMP
3649 .set_affinity = set_ht_irq_affinity,
3650#endif
3651 .retrigger = ioapic_retrigger_irq,
3652};
3653
3654int arch_setup_ht_irq(unsigned int irq, struct pci_dev *dev)
3655{
Yinghai Lu497c9a12008-08-19 20:50:28 -07003656 struct irq_cfg *cfg;
3657 int err;
3658 cpumask_t tmp;
Eric W. Biederman8b955b02006-10-04 02:16:55 -07003659
Yinghai Lu497c9a12008-08-19 20:50:28 -07003660 tmp = TARGET_CPUS;
3661 err = assign_irq_vector(irq, tmp);
Ingo Molnar54168ed2008-08-20 09:07:45 +02003662 if (!err) {
Eric W. Biedermanec683072006-11-08 17:44:57 -08003663 struct ht_irq_msg msg;
Eric W. Biederman8b955b02006-10-04 02:16:55 -07003664 unsigned dest;
Eric W. Biederman8b955b02006-10-04 02:16:55 -07003665
Yinghai Lu497c9a12008-08-19 20:50:28 -07003666 cfg = irq_cfg(irq);
3667 cpus_and(tmp, cfg->domain, tmp);
Eric W. Biederman8b955b02006-10-04 02:16:55 -07003668 dest = cpu_mask_to_apicid(tmp);
3669
Eric W. Biedermanec683072006-11-08 17:44:57 -08003670 msg.address_hi = HT_IRQ_HIGH_DEST_ID(dest);
Eric W. Biederman8b955b02006-10-04 02:16:55 -07003671
Eric W. Biedermanec683072006-11-08 17:44:57 -08003672 msg.address_lo =
3673 HT_IRQ_LOW_BASE |
Eric W. Biederman8b955b02006-10-04 02:16:55 -07003674 HT_IRQ_LOW_DEST_ID(dest) |
Yinghai Lu497c9a12008-08-19 20:50:28 -07003675 HT_IRQ_LOW_VECTOR(cfg->vector) |
Eric W. Biederman8b955b02006-10-04 02:16:55 -07003676 ((INT_DEST_MODE == 0) ?
3677 HT_IRQ_LOW_DM_PHYSICAL :
3678 HT_IRQ_LOW_DM_LOGICAL) |
3679 HT_IRQ_LOW_RQEOI_EDGE |
3680 ((INT_DELIVERY_MODE != dest_LowestPrio) ?
3681 HT_IRQ_LOW_MT_FIXED :
3682 HT_IRQ_LOW_MT_ARBITRATED) |
3683 HT_IRQ_LOW_IRQ_MASKED;
3684
Eric W. Biedermanec683072006-11-08 17:44:57 -08003685 write_ht_irq_msg(irq, &msg);
Eric W. Biederman8b955b02006-10-04 02:16:55 -07003686
Ingo Molnara460e742006-10-17 00:10:03 -07003687 set_irq_chip_and_handler_name(irq, &ht_irq_chip,
3688 handle_edge_irq, "edge");
Eric W. Biederman8b955b02006-10-04 02:16:55 -07003689 }
Yinghai Lu497c9a12008-08-19 20:50:28 -07003690 return err;
Eric W. Biederman8b955b02006-10-04 02:16:55 -07003691}
3692#endif /* CONFIG_HT_IRQ */
3693
Yinghai Lu9d6a4d02008-08-19 20:50:52 -07003694int __init io_apic_get_redir_entries (int ioapic)
3695{
3696 union IO_APIC_reg_01 reg_01;
3697 unsigned long flags;
3698
3699 spin_lock_irqsave(&ioapic_lock, flags);
3700 reg_01.raw = io_apic_read(ioapic, 1);
3701 spin_unlock_irqrestore(&ioapic_lock, flags);
3702
3703 return reg_01.bits.entries;
3704}
3705
3706int __init probe_nr_irqs(void)
3707{
3708 int idx;
3709 int nr = 0;
Yinghai Lu052c0bf2008-08-21 13:10:09 -07003710#ifndef CONFIG_XEN
3711 int nr_min = 32;
3712#else
3713 int nr_min = NR_IRQS;
3714#endif
Yinghai Lu9d6a4d02008-08-19 20:50:52 -07003715
3716 for (idx = 0; idx < nr_ioapics; idx++)
Yinghai Lu052c0bf2008-08-21 13:10:09 -07003717 nr += io_apic_get_redir_entries(idx) + 1;
Yinghai Lu9d6a4d02008-08-19 20:50:52 -07003718
3719 /* double it for hotplug and msi and nmi */
3720 nr <<= 1;
3721
3722 /* something wrong ? */
Yinghai Lu052c0bf2008-08-21 13:10:09 -07003723 if (nr < nr_min)
3724 nr = nr_min;
Yinghai Lu9d6a4d02008-08-19 20:50:52 -07003725
3726 return nr;
3727}
3728
Linus Torvalds1da177e2005-04-16 15:20:36 -07003729/* --------------------------------------------------------------------------
Ingo Molnar54168ed2008-08-20 09:07:45 +02003730 ACPI-based IOAPIC Configuration
Linus Torvalds1da177e2005-04-16 15:20:36 -07003731 -------------------------------------------------------------------------- */
3732
Len Brown888ba6c2005-08-24 12:07:20 -04003733#ifdef CONFIG_ACPI
Linus Torvalds1da177e2005-04-16 15:20:36 -07003734
Ingo Molnar54168ed2008-08-20 09:07:45 +02003735#ifdef CONFIG_X86_32
Paolo Ciarrocchi36062442008-06-08 13:07:18 +02003736int __init io_apic_get_unique_id(int ioapic, int apic_id)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003737{
3738 union IO_APIC_reg_00 reg_00;
3739 static physid_mask_t apic_id_map = PHYSID_MASK_NONE;
3740 physid_mask_t tmp;
3741 unsigned long flags;
3742 int i = 0;
3743
3744 /*
Paolo Ciarrocchi36062442008-06-08 13:07:18 +02003745 * The P4 platform supports up to 256 APIC IDs on two separate APIC
3746 * buses (one for LAPICs, one for IOAPICs), where predecessors only
Linus Torvalds1da177e2005-04-16 15:20:36 -07003747 * supports up to 16 on one shared APIC bus.
Paolo Ciarrocchi36062442008-06-08 13:07:18 +02003748 *
Linus Torvalds1da177e2005-04-16 15:20:36 -07003749 * TBD: Expand LAPIC/IOAPIC support on P4-class systems to take full
3750 * advantage of new APIC bus architecture.
3751 */
3752
3753 if (physids_empty(apic_id_map))
3754 apic_id_map = ioapic_phys_id_map(phys_cpu_present_map);
3755
3756 spin_lock_irqsave(&ioapic_lock, flags);
3757 reg_00.raw = io_apic_read(ioapic, 0);
3758 spin_unlock_irqrestore(&ioapic_lock, flags);
3759
3760 if (apic_id >= get_physical_broadcast()) {
3761 printk(KERN_WARNING "IOAPIC[%d]: Invalid apic_id %d, trying "
3762 "%d\n", ioapic, apic_id, reg_00.bits.ID);
3763 apic_id = reg_00.bits.ID;
3764 }
3765
3766 /*
Paolo Ciarrocchi36062442008-06-08 13:07:18 +02003767 * Every APIC in a system must have a unique ID or we get lots of nice
Linus Torvalds1da177e2005-04-16 15:20:36 -07003768 * 'stuck on smp_invalidate_needed IPI wait' messages.
3769 */
3770 if (check_apicid_used(apic_id_map, apic_id)) {
3771
3772 for (i = 0; i < get_physical_broadcast(); i++) {
3773 if (!check_apicid_used(apic_id_map, i))
3774 break;
3775 }
3776
3777 if (i == get_physical_broadcast())
3778 panic("Max apic_id exceeded!\n");
3779
3780 printk(KERN_WARNING "IOAPIC[%d]: apic_id %d already used, "
3781 "trying %d\n", ioapic, apic_id, i);
3782
3783 apic_id = i;
Paolo Ciarrocchi36062442008-06-08 13:07:18 +02003784 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07003785
3786 tmp = apicid_to_cpu_present(apic_id);
3787 physids_or(apic_id_map, apic_id_map, tmp);
3788
3789 if (reg_00.bits.ID != apic_id) {
3790 reg_00.bits.ID = apic_id;
3791
3792 spin_lock_irqsave(&ioapic_lock, flags);
3793 io_apic_write(ioapic, 0, reg_00.raw);
3794 reg_00.raw = io_apic_read(ioapic, 0);
3795 spin_unlock_irqrestore(&ioapic_lock, flags);
3796
3797 /* Sanity check */
Andreas Deresch6070f9e2006-02-26 04:18:34 +01003798 if (reg_00.bits.ID != apic_id) {
3799 printk("IOAPIC[%d]: Unable to change apic_id!\n", ioapic);
3800 return -1;
3801 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07003802 }
3803
3804 apic_printk(APIC_VERBOSE, KERN_INFO
3805 "IOAPIC[%d]: Assigned apic_id %d\n", ioapic, apic_id);
3806
3807 return apic_id;
3808}
3809
Paolo Ciarrocchi36062442008-06-08 13:07:18 +02003810int __init io_apic_get_version(int ioapic)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003811{
3812 union IO_APIC_reg_01 reg_01;
3813 unsigned long flags;
3814
3815 spin_lock_irqsave(&ioapic_lock, flags);
3816 reg_01.raw = io_apic_read(ioapic, 1);
3817 spin_unlock_irqrestore(&ioapic_lock, flags);
3818
3819 return reg_01.bits.version;
3820}
Ingo Molnar54168ed2008-08-20 09:07:45 +02003821#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -07003822
Ingo Molnar54168ed2008-08-20 09:07:45 +02003823int io_apic_set_pci_routing (int ioapic, int pin, int irq, int triggering, int polarity)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003824{
Linus Torvalds1da177e2005-04-16 15:20:36 -07003825 if (!IO_APIC_IRQ(irq)) {
Ingo Molnar54168ed2008-08-20 09:07:45 +02003826 apic_printk(APIC_QUIET,KERN_ERR "IOAPIC[%d]: Invalid reference to IRQ 0\n",
Linus Torvalds1da177e2005-04-16 15:20:36 -07003827 ioapic);
3828 return -EINVAL;
3829 }
3830
3831 /*
Linus Torvalds1da177e2005-04-16 15:20:36 -07003832 * IRQs < 16 are already in the irq_2_pin[] map
3833 */
3834 if (irq >= 16)
3835 add_pin_to_irq(irq, ioapic, pin);
3836
Yinghai Lu497c9a12008-08-19 20:50:28 -07003837 setup_IO_APIC_irq(ioapic, pin, irq, triggering, polarity);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003838
3839 return 0;
3840}
3841
Ingo Molnar54168ed2008-08-20 09:07:45 +02003842
Shaohua Li61fd47e2007-11-17 01:05:28 -05003843int acpi_get_override_irq(int bus_irq, int *trigger, int *polarity)
3844{
3845 int i;
3846
3847 if (skip_ioapic_setup)
3848 return -1;
3849
3850 for (i = 0; i < mp_irq_entries; i++)
Alexey Starikovskiy2fddb6e282008-05-14 19:03:17 +04003851 if (mp_irqs[i].mp_irqtype == mp_INT &&
3852 mp_irqs[i].mp_srcbusirq == bus_irq)
Shaohua Li61fd47e2007-11-17 01:05:28 -05003853 break;
3854 if (i >= mp_irq_entries)
3855 return -1;
3856
3857 *trigger = irq_trigger(i);
3858 *polarity = irq_polarity(i);
3859 return 0;
3860}
3861
Len Brown888ba6c2005-08-24 12:07:20 -04003862#endif /* CONFIG_ACPI */
Rusty Russell1a3f2392006-09-26 10:52:32 +02003863
Yinghai Lu497c9a12008-08-19 20:50:28 -07003864/*
3865 * This function currently is only a helper for the i386 smp boot process where
3866 * we need to reprogram the ioredtbls to cater for the cpus which have come online
3867 * so mask in all cases should simply be TARGET_CPUS
3868 */
3869#ifdef CONFIG_SMP
3870void __init setup_ioapic_dest(void)
3871{
3872 int pin, ioapic, irq, irq_entry;
3873 struct irq_cfg *cfg;
Yinghai Lu497c9a12008-08-19 20:50:28 -07003874
3875 if (skip_ioapic_setup == 1)
3876 return;
3877
3878 for (ioapic = 0; ioapic < nr_ioapics; ioapic++) {
3879 for (pin = 0; pin < nr_ioapic_registers[ioapic]; pin++) {
3880 irq_entry = find_irq_entry(ioapic, pin, mp_INT);
3881 if (irq_entry == -1)
3882 continue;
3883 irq = pin_2_irq(irq_entry, ioapic, pin);
3884
3885 /* setup_IO_APIC_irqs could fail to get vector for some device
3886 * when you have too many devices, because at that time only boot
3887 * cpu is online.
3888 */
3889 cfg = irq_cfg(irq);
3890 if (!cfg->vector)
3891 setup_IO_APIC_irq(ioapic, pin, irq,
3892 irq_trigger(irq_entry),
3893 irq_polarity(irq_entry));
Ingo Molnar54168ed2008-08-20 09:07:45 +02003894#ifdef CONFIG_INTR_REMAP
3895 else if (intr_remapping_enabled)
3896 set_ir_ioapic_affinity_irq(irq, TARGET_CPUS);
3897#endif
3898 else
Yinghai Lu497c9a12008-08-19 20:50:28 -07003899 set_ioapic_affinity_irq(irq, TARGET_CPUS);
Yinghai Lu497c9a12008-08-19 20:50:28 -07003900 }
3901
3902 }
3903}
3904#endif
3905
Ingo Molnar54168ed2008-08-20 09:07:45 +02003906#define IOAPIC_RESOURCE_NAME_SIZE 11
3907
3908static struct resource *ioapic_resources;
3909
3910static struct resource * __init ioapic_setup_resources(void)
3911{
3912 unsigned long n;
3913 struct resource *res;
3914 char *mem;
3915 int i;
3916
3917 if (nr_ioapics <= 0)
3918 return NULL;
3919
3920 n = IOAPIC_RESOURCE_NAME_SIZE + sizeof(struct resource);
3921 n *= nr_ioapics;
3922
3923 mem = alloc_bootmem(n);
3924 res = (void *)mem;
3925
3926 if (mem != NULL) {
3927 mem += sizeof(struct resource) * nr_ioapics;
3928
3929 for (i = 0; i < nr_ioapics; i++) {
3930 res[i].name = mem;
3931 res[i].flags = IORESOURCE_MEM | IORESOURCE_BUSY;
3932 sprintf(mem, "IOAPIC %u", i);
3933 mem += IOAPIC_RESOURCE_NAME_SIZE;
3934 }
3935 }
3936
3937 ioapic_resources = res;
3938
3939 return res;
3940}
Ingo Molnar54168ed2008-08-20 09:07:45 +02003941
Yinghai Luf3294a32008-06-27 01:41:56 -07003942void __init ioapic_init_mappings(void)
3943{
3944 unsigned long ioapic_phys, idx = FIX_IO_APIC_BASE_0;
3945 int i;
Ingo Molnar54168ed2008-08-20 09:07:45 +02003946 struct resource *ioapic_res;
Yinghai Luf3294a32008-06-27 01:41:56 -07003947
Ingo Molnar54168ed2008-08-20 09:07:45 +02003948 ioapic_res = ioapic_setup_resources();
Yinghai Luf3294a32008-06-27 01:41:56 -07003949 for (i = 0; i < nr_ioapics; i++) {
3950 if (smp_found_config) {
3951 ioapic_phys = mp_ioapics[i].mp_apicaddr;
Ingo Molnar54168ed2008-08-20 09:07:45 +02003952#ifdef CONFIG_X86_32
3953 if (!ioapic_phys) {
3954 printk(KERN_ERR
3955 "WARNING: bogus zero IO-APIC "
3956 "address found in MPTABLE, "
3957 "disabling IO/APIC support!\n");
3958 smp_found_config = 0;
3959 skip_ioapic_setup = 1;
3960 goto fake_ioapic_page;
3961 }
3962#endif
Yinghai Luf3294a32008-06-27 01:41:56 -07003963 } else {
Ingo Molnar54168ed2008-08-20 09:07:45 +02003964#ifdef CONFIG_X86_32
Yinghai Luf3294a32008-06-27 01:41:56 -07003965fake_ioapic_page:
Ingo Molnar54168ed2008-08-20 09:07:45 +02003966#endif
Yinghai Luf3294a32008-06-27 01:41:56 -07003967 ioapic_phys = (unsigned long)
Ingo Molnar54168ed2008-08-20 09:07:45 +02003968 alloc_bootmem_pages(PAGE_SIZE);
Yinghai Luf3294a32008-06-27 01:41:56 -07003969 ioapic_phys = __pa(ioapic_phys);
3970 }
3971 set_fixmap_nocache(idx, ioapic_phys);
Ingo Molnar54168ed2008-08-20 09:07:45 +02003972 apic_printk(APIC_VERBOSE,
3973 "mapped IOAPIC to %08lx (%08lx)\n",
3974 __fix_to_virt(idx), ioapic_phys);
Yinghai Luf3294a32008-06-27 01:41:56 -07003975 idx++;
Ingo Molnar54168ed2008-08-20 09:07:45 +02003976
Ingo Molnar54168ed2008-08-20 09:07:45 +02003977 if (ioapic_res != NULL) {
3978 ioapic_res->start = ioapic_phys;
3979 ioapic_res->end = ioapic_phys + (4 * 1024) - 1;
3980 ioapic_res++;
3981 }
Yinghai Luf3294a32008-06-27 01:41:56 -07003982 }
3983}
3984
Ingo Molnar54168ed2008-08-20 09:07:45 +02003985static int __init ioapic_insert_resources(void)
3986{
3987 int i;
3988 struct resource *r = ioapic_resources;
3989
3990 if (!r) {
3991 printk(KERN_ERR
3992 "IO APIC resources could be not be allocated.\n");
3993 return -1;
3994 }
3995
3996 for (i = 0; i < nr_ioapics; i++) {
3997 insert_resource(&iomem_resource, r);
3998 r++;
3999 }
4000
4001 return 0;
4002}
4003
4004/* Insert the IO APIC resources after PCI initialization has occured to handle
4005 * IO APICS that are mapped in on a BAR in PCI space. */
4006late_initcall(ioapic_insert_resources);