[IA64] operator priority fix in acpi_map_lsapic()
[linux-2.6] / arch / ia64 / kernel / acpi.c
1 /*
2  *  acpi.c - Architecture-Specific Low-Level ACPI Support
3  *
4  *  Copyright (C) 1999 VA Linux Systems
5  *  Copyright (C) 1999,2000 Walt Drummond <drummond@valinux.com>
6  *  Copyright (C) 2000, 2002-2003 Hewlett-Packard Co.
7  *      David Mosberger-Tang <davidm@hpl.hp.com>
8  *  Copyright (C) 2000 Intel Corp.
9  *  Copyright (C) 2000,2001 J.I. Lee <jung-ik.lee@intel.com>
10  *  Copyright (C) 2001 Paul Diefenbaugh <paul.s.diefenbaugh@intel.com>
11  *  Copyright (C) 2001 Jenna Hall <jenna.s.hall@intel.com>
12  *  Copyright (C) 2001 Takayoshi Kochi <t-kochi@bq.jp.nec.com>
13  *  Copyright (C) 2002 Erich Focht <efocht@ess.nec.de>
14  *  Copyright (C) 2004 Ashok Raj <ashok.raj@intel.com>
15  *
16  * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
17  *
18  *  This program is free software; you can redistribute it and/or modify
19  *  it under the terms of the GNU General Public License as published by
20  *  the Free Software Foundation; either version 2 of the License, or
21  *  (at your option) any later version.
22  *
23  *  This program is distributed in the hope that it will be useful,
24  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
25  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
26  *  GNU General Public License for more details.
27  *
28  *  You should have received a copy of the GNU General Public License
29  *  along with this program; if not, write to the Free Software
30  *  Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
31  *
32  * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
33  */
34
35 #include <linux/module.h>
36 #include <linux/init.h>
37 #include <linux/kernel.h>
38 #include <linux/sched.h>
39 #include <linux/smp.h>
40 #include <linux/string.h>
41 #include <linux/types.h>
42 #include <linux/irq.h>
43 #include <linux/acpi.h>
44 #include <linux/efi.h>
45 #include <linux/mmzone.h>
46 #include <linux/nodemask.h>
47 #include <asm/io.h>
48 #include <asm/iosapic.h>
49 #include <asm/machvec.h>
50 #include <asm/page.h>
51 #include <asm/system.h>
52 #include <asm/numa.h>
53 #include <asm/sal.h>
54 #include <asm/cyclone.h>
55
56 #define BAD_MADT_ENTRY(entry, end) (                                        \
57                 (!entry) || (unsigned long)entry + sizeof(*entry) > end ||  \
58                 ((struct acpi_subtable_header *)entry)->length < sizeof(*entry))
59
60 #define PREFIX                  "ACPI: "
61
62 void (*pm_idle) (void);
63 EXPORT_SYMBOL(pm_idle);
64 void (*pm_power_off) (void);
65 EXPORT_SYMBOL(pm_power_off);
66
67 unsigned int acpi_cpei_override;
68 unsigned int acpi_cpei_phys_cpuid;
69
70 unsigned long acpi_wakeup_address = 0;
71
72 const char __init *
73 acpi_get_sysname(void)
74 {
75 #ifdef CONFIG_IA64_GENERIC
76         unsigned long rsdp_phys;
77         struct acpi_table_rsdp *rsdp;
78         struct acpi_table_xsdt *xsdt;
79         struct acpi_table_header *hdr;
80
81         rsdp_phys = acpi_find_rsdp();
82         if (!rsdp_phys) {
83                 printk(KERN_ERR
84                        "ACPI 2.0 RSDP not found, default to \"dig\"\n");
85                 return "dig";
86         }
87
88         rsdp = (struct acpi_table_rsdp *)__va(rsdp_phys);
89         if (strncmp(rsdp->signature, ACPI_SIG_RSDP, sizeof(ACPI_SIG_RSDP) - 1)) {
90                 printk(KERN_ERR
91                        "ACPI 2.0 RSDP signature incorrect, default to \"dig\"\n");
92                 return "dig";
93         }
94
95         xsdt = (struct acpi_table_xsdt *)__va(rsdp->xsdt_physical_address);
96         hdr = &xsdt->header;
97         if (strncmp(hdr->signature, ACPI_SIG_XSDT, sizeof(ACPI_SIG_XSDT) - 1)) {
98                 printk(KERN_ERR
99                        "ACPI 2.0 XSDT signature incorrect, default to \"dig\"\n");
100                 return "dig";
101         }
102
103         if (!strcmp(hdr->oem_id, "HP")) {
104                 return "hpzx1";
105         } else if (!strcmp(hdr->oem_id, "SGI")) {
106                 return "sn2";
107         }
108
109         return "dig";
110 #else
111 # if defined (CONFIG_IA64_HP_SIM)
112         return "hpsim";
113 # elif defined (CONFIG_IA64_HP_ZX1)
114         return "hpzx1";
115 # elif defined (CONFIG_IA64_HP_ZX1_SWIOTLB)
116         return "hpzx1_swiotlb";
117 # elif defined (CONFIG_IA64_SGI_SN2)
118         return "sn2";
119 # elif defined (CONFIG_IA64_DIG)
120         return "dig";
121 # else
122 #       error Unknown platform.  Fix acpi.c.
123 # endif
124 #endif
125 }
126
127 #ifdef CONFIG_ACPI
128
129 #define ACPI_MAX_PLATFORM_INTERRUPTS    256
130
131 /* Array to record platform interrupt vectors for generic interrupt routing. */
132 int platform_intr_list[ACPI_MAX_PLATFORM_INTERRUPTS] = {
133         [0 ... ACPI_MAX_PLATFORM_INTERRUPTS - 1] = -1
134 };
135
136 enum acpi_irq_model_id acpi_irq_model = ACPI_IRQ_MODEL_IOSAPIC;
137
138 /*
139  * Interrupt routing API for device drivers.  Provides interrupt vector for
140  * a generic platform event.  Currently only CPEI is implemented.
141  */
142 int acpi_request_vector(u32 int_type)
143 {
144         int vector = -1;
145
146         if (int_type < ACPI_MAX_PLATFORM_INTERRUPTS) {
147                 /* corrected platform error interrupt */
148                 vector = platform_intr_list[int_type];
149         } else
150                 printk(KERN_ERR
151                        "acpi_request_vector(): invalid interrupt type\n");
152         return vector;
153 }
154
155 char *__acpi_map_table(unsigned long phys_addr, unsigned long size)
156 {
157         return __va(phys_addr);
158 }
159
160 /* --------------------------------------------------------------------------
161                             Boot-time Table Parsing
162    -------------------------------------------------------------------------- */
163
164 static int total_cpus __initdata;
165 static int available_cpus __initdata;
166 struct acpi_table_madt *acpi_madt __initdata;
167 static u8 has_8259;
168
169 static int __init
170 acpi_parse_lapic_addr_ovr(struct acpi_subtable_header * header,
171                           const unsigned long end)
172 {
173         struct acpi_madt_local_apic_override *lapic;
174
175         lapic = (struct acpi_madt_local_apic_override *)header;
176
177         if (BAD_MADT_ENTRY(lapic, end))
178                 return -EINVAL;
179
180         if (lapic->address) {
181                 iounmap(ipi_base_addr);
182                 ipi_base_addr = ioremap(lapic->address, 0);
183         }
184         return 0;
185 }
186
187 static int __init
188 acpi_parse_lsapic(struct acpi_subtable_header * header, const unsigned long end)
189 {
190         struct acpi_madt_local_sapic *lsapic;
191
192         lsapic = (struct acpi_madt_local_sapic *)header;
193
194         /*Skip BAD_MADT_ENTRY check, as lsapic size could vary */
195
196         if (lsapic->lapic_flags & ACPI_MADT_ENABLED) {
197 #ifdef CONFIG_SMP
198                 smp_boot_data.cpu_phys_id[available_cpus] =
199                     (lsapic->id << 8) | lsapic->eid;
200 #endif
201                 ++available_cpus;
202         }
203
204         total_cpus++;
205         return 0;
206 }
207
208 static int __init
209 acpi_parse_lapic_nmi(struct acpi_subtable_header * header, const unsigned long end)
210 {
211         struct acpi_madt_local_apic_nmi *lacpi_nmi;
212
213         lacpi_nmi = (struct acpi_madt_local_apic_nmi *)header;
214
215         if (BAD_MADT_ENTRY(lacpi_nmi, end))
216                 return -EINVAL;
217
218         /* TBD: Support lapic_nmi entries */
219         return 0;
220 }
221
222 static int __init
223 acpi_parse_iosapic(struct acpi_subtable_header * header, const unsigned long end)
224 {
225         struct acpi_madt_io_sapic *iosapic;
226
227         iosapic = (struct acpi_madt_io_sapic *)header;
228
229         if (BAD_MADT_ENTRY(iosapic, end))
230                 return -EINVAL;
231
232         return iosapic_init(iosapic->address, iosapic->global_irq_base);
233 }
234
235 static unsigned int __initdata acpi_madt_rev;
236
237 static int __init
238 acpi_parse_plat_int_src(struct acpi_subtable_header * header,
239                         const unsigned long end)
240 {
241         struct acpi_madt_interrupt_source *plintsrc;
242         int vector;
243
244         plintsrc = (struct acpi_madt_interrupt_source *)header;
245
246         if (BAD_MADT_ENTRY(plintsrc, end))
247                 return -EINVAL;
248
249         /*
250          * Get vector assignment for this interrupt, set attributes,
251          * and program the IOSAPIC routing table.
252          */
253         vector = iosapic_register_platform_intr(plintsrc->type,
254                                                 plintsrc->global_irq,
255                                                 plintsrc->io_sapic_vector,
256                                                 plintsrc->eid,
257                                                 plintsrc->id,
258                                                 ((plintsrc->inti_flags & ACPI_MADT_POLARITY_MASK) ==
259                                                  ACPI_MADT_POLARITY_ACTIVE_HIGH) ?
260                                                 IOSAPIC_POL_HIGH : IOSAPIC_POL_LOW,
261                                                 ((plintsrc->inti_flags & ACPI_MADT_TRIGGER_MASK) ==
262                                                  ACPI_MADT_TRIGGER_EDGE) ?
263                                                 IOSAPIC_EDGE : IOSAPIC_LEVEL);
264
265         platform_intr_list[plintsrc->type] = vector;
266         if (acpi_madt_rev > 1) {
267                 acpi_cpei_override = plintsrc->flags & ACPI_MADT_CPEI_OVERRIDE;
268         }
269
270         /*
271          * Save the physical id, so we can check when its being removed
272          */
273         acpi_cpei_phys_cpuid = ((plintsrc->id << 8) | (plintsrc->eid)) & 0xffff;
274
275         return 0;
276 }
277
278 #ifdef CONFIG_HOTPLUG_CPU
279 unsigned int can_cpei_retarget(void)
280 {
281         extern int cpe_vector;
282         extern unsigned int force_cpei_retarget;
283
284         /*
285          * Only if CPEI is supported and the override flag
286          * is present, otherwise return that its re-targettable
287          * if we are in polling mode.
288          */
289         if (cpe_vector > 0) {
290                 if (acpi_cpei_override || force_cpei_retarget)
291                         return 1;
292                 else
293                         return 0;
294         }
295         return 1;
296 }
297
298 unsigned int is_cpu_cpei_target(unsigned int cpu)
299 {
300         unsigned int logical_id;
301
302         logical_id = cpu_logical_id(acpi_cpei_phys_cpuid);
303
304         if (logical_id == cpu)
305                 return 1;
306         else
307                 return 0;
308 }
309
310 void set_cpei_target_cpu(unsigned int cpu)
311 {
312         acpi_cpei_phys_cpuid = cpu_physical_id(cpu);
313 }
314 #endif
315
316 unsigned int get_cpei_target_cpu(void)
317 {
318         return acpi_cpei_phys_cpuid;
319 }
320
321 static int __init
322 acpi_parse_int_src_ovr(struct acpi_subtable_header * header,
323                        const unsigned long end)
324 {
325         struct acpi_madt_interrupt_override *p;
326
327         p = (struct acpi_madt_interrupt_override *)header;
328
329         if (BAD_MADT_ENTRY(p, end))
330                 return -EINVAL;
331
332         iosapic_override_isa_irq(p->source_irq, p->global_irq,
333                                  ((p->inti_flags & ACPI_MADT_POLARITY_MASK) ==
334                                   ACPI_MADT_POLARITY_ACTIVE_HIGH) ?
335                                  IOSAPIC_POL_HIGH : IOSAPIC_POL_LOW,
336                                  ((p->inti_flags & ACPI_MADT_TRIGGER_MASK) ==
337                                  ACPI_MADT_TRIGGER_EDGE) ?
338                                  IOSAPIC_EDGE : IOSAPIC_LEVEL);
339         return 0;
340 }
341
342 static int __init
343 acpi_parse_nmi_src(struct acpi_subtable_header * header, const unsigned long end)
344 {
345         struct acpi_madt_nmi_source *nmi_src;
346
347         nmi_src = (struct acpi_madt_nmi_source *)header;
348
349         if (BAD_MADT_ENTRY(nmi_src, end))
350                 return -EINVAL;
351
352         /* TBD: Support nimsrc entries */
353         return 0;
354 }
355
356 static void __init acpi_madt_oem_check(char *oem_id, char *oem_table_id)
357 {
358         if (!strncmp(oem_id, "IBM", 3) && (!strncmp(oem_table_id, "SERMOW", 6))) {
359
360                 /*
361                  * Unfortunately ITC_DRIFT is not yet part of the
362                  * official SAL spec, so the ITC_DRIFT bit is not
363                  * set by the BIOS on this hardware.
364                  */
365                 sal_platform_features |= IA64_SAL_PLATFORM_FEATURE_ITC_DRIFT;
366
367                 cyclone_setup();
368         }
369 }
370
371 static int __init acpi_parse_madt(struct acpi_table_header *table)
372 {
373         if (!table)
374                 return -EINVAL;
375
376         acpi_madt = (struct acpi_table_madt *)table;
377
378         acpi_madt_rev = acpi_madt->header.revision;
379
380         /* remember the value for reference after free_initmem() */
381 #ifdef CONFIG_ITANIUM
382         has_8259 = 1;           /* Firmware on old Itanium systems is broken */
383 #else
384         has_8259 = acpi_madt->flags & ACPI_MADT_PCAT_COMPAT;
385 #endif
386         iosapic_system_init(has_8259);
387
388         /* Get base address of IPI Message Block */
389
390         if (acpi_madt->address)
391                 ipi_base_addr = ioremap(acpi_madt->address, 0);
392
393         printk(KERN_INFO PREFIX "Local APIC address %p\n", ipi_base_addr);
394
395         acpi_madt_oem_check(acpi_madt->header.oem_id,
396                             acpi_madt->header.oem_table_id);
397
398         return 0;
399 }
400
401 #ifdef CONFIG_ACPI_NUMA
402
403 #undef SLIT_DEBUG
404
405 #define PXM_FLAG_LEN ((MAX_PXM_DOMAINS + 1)/32)
406
407 static int __initdata srat_num_cpus;    /* number of cpus */
408 static u32 __devinitdata pxm_flag[PXM_FLAG_LEN];
409 #define pxm_bit_set(bit)        (set_bit(bit,(void *)pxm_flag))
410 #define pxm_bit_test(bit)       (test_bit(bit,(void *)pxm_flag))
411 static struct acpi_table_slit __initdata *slit_table;
412
413 static int get_processor_proximity_domain(struct acpi_srat_cpu_affinity *pa)
414 {
415         int pxm;
416
417         pxm = pa->proximity_domain_lo;
418         if (ia64_platform_is("sn2"))
419                 pxm += pa->proximity_domain_hi[0] << 8;
420         return pxm;
421 }
422
423 static int get_memory_proximity_domain(struct acpi_srat_mem_affinity *ma)
424 {
425         int pxm;
426
427         pxm = ma->proximity_domain;
428         if (!ia64_platform_is("sn2"))
429                 pxm &= 0xff;
430
431         return pxm;
432 }
433
434 /*
435  * ACPI 2.0 SLIT (System Locality Information Table)
436  * http://devresource.hp.com/devresource/Docs/TechPapers/IA64/slit.pdf
437  */
438 void __init acpi_numa_slit_init(struct acpi_table_slit *slit)
439 {
440         u32 len;
441
442         len = sizeof(struct acpi_table_header) + 8
443             + slit->locality_count * slit->locality_count;
444         if (slit->header.length != len) {
445                 printk(KERN_ERR
446                        "ACPI 2.0 SLIT: size mismatch: %d expected, %d actual\n",
447                        len, slit->header.length);
448                 memset(numa_slit, 10, sizeof(numa_slit));
449                 return;
450         }
451         slit_table = slit;
452 }
453
454 void __init
455 acpi_numa_processor_affinity_init(struct acpi_srat_cpu_affinity *pa)
456 {
457         int pxm;
458
459         if (!(pa->flags & ACPI_SRAT_CPU_ENABLED))
460                 return;
461
462         pxm = get_processor_proximity_domain(pa);
463
464         /* record this node in proximity bitmap */
465         pxm_bit_set(pxm);
466
467         node_cpuid[srat_num_cpus].phys_id =
468             (pa->apic_id << 8) | (pa->local_sapic_eid);
469         /* nid should be overridden as logical node id later */
470         node_cpuid[srat_num_cpus].nid = pxm;
471         srat_num_cpus++;
472 }
473
474 void __init
475 acpi_numa_memory_affinity_init(struct acpi_srat_mem_affinity *ma)
476 {
477         unsigned long paddr, size;
478         int pxm;
479         struct node_memblk_s *p, *q, *pend;
480
481         pxm = get_memory_proximity_domain(ma);
482
483         /* fill node memory chunk structure */
484         paddr = ma->base_address;
485         size = ma->length;
486
487         /* Ignore disabled entries */
488         if (!(ma->flags & ACPI_SRAT_MEM_ENABLED))
489                 return;
490
491         /* record this node in proximity bitmap */
492         pxm_bit_set(pxm);
493
494         /* Insertion sort based on base address */
495         pend = &node_memblk[num_node_memblks];
496         for (p = &node_memblk[0]; p < pend; p++) {
497                 if (paddr < p->start_paddr)
498                         break;
499         }
500         if (p < pend) {
501                 for (q = pend - 1; q >= p; q--)
502                         *(q + 1) = *q;
503         }
504         p->start_paddr = paddr;
505         p->size = size;
506         p->nid = pxm;
507         num_node_memblks++;
508 }
509
510 void __init acpi_numa_arch_fixup(void)
511 {
512         int i, j, node_from, node_to;
513
514         /* If there's no SRAT, fix the phys_id and mark node 0 online */
515         if (srat_num_cpus == 0) {
516                 node_set_online(0);
517                 node_cpuid[0].phys_id = hard_smp_processor_id();
518                 return;
519         }
520
521         /*
522          * MCD - This can probably be dropped now.  No need for pxm ID to node ID
523          * mapping with sparse node numbering iff MAX_PXM_DOMAINS <= MAX_NUMNODES.
524          */
525         nodes_clear(node_online_map);
526         for (i = 0; i < MAX_PXM_DOMAINS; i++) {
527                 if (pxm_bit_test(i)) {
528                         int nid = acpi_map_pxm_to_node(i);
529                         node_set_online(nid);
530                 }
531         }
532
533         /* set logical node id in memory chunk structure */
534         for (i = 0; i < num_node_memblks; i++)
535                 node_memblk[i].nid = pxm_to_node(node_memblk[i].nid);
536
537         /* assign memory bank numbers for each chunk on each node */
538         for_each_online_node(i) {
539                 int bank;
540
541                 bank = 0;
542                 for (j = 0; j < num_node_memblks; j++)
543                         if (node_memblk[j].nid == i)
544                                 node_memblk[j].bank = bank++;
545         }
546
547         /* set logical node id in cpu structure */
548         for (i = 0; i < srat_num_cpus; i++)
549                 node_cpuid[i].nid = pxm_to_node(node_cpuid[i].nid);
550
551         printk(KERN_INFO "Number of logical nodes in system = %d\n",
552                num_online_nodes());
553         printk(KERN_INFO "Number of memory chunks in system = %d\n",
554                num_node_memblks);
555
556         if (!slit_table)
557                 return;
558         memset(numa_slit, -1, sizeof(numa_slit));
559         for (i = 0; i < slit_table->locality_count; i++) {
560                 if (!pxm_bit_test(i))
561                         continue;
562                 node_from = pxm_to_node(i);
563                 for (j = 0; j < slit_table->locality_count; j++) {
564                         if (!pxm_bit_test(j))
565                                 continue;
566                         node_to = pxm_to_node(j);
567                         node_distance(node_from, node_to) =
568                             slit_table->entry[i * slit_table->locality_count + j];
569                 }
570         }
571
572 #ifdef SLIT_DEBUG
573         printk("ACPI 2.0 SLIT locality table:\n");
574         for_each_online_node(i) {
575                 for_each_online_node(j)
576                     printk("%03d ", node_distance(i, j));
577                 printk("\n");
578         }
579 #endif
580 }
581 #endif                          /* CONFIG_ACPI_NUMA */
582
583 /*
584  * success: return IRQ number (>=0)
585  * failure: return < 0
586  */
587 int acpi_register_gsi(u32 gsi, int triggering, int polarity)
588 {
589         if (acpi_irq_model == ACPI_IRQ_MODEL_PLATFORM)
590                 return gsi;
591
592         if (has_8259 && gsi < 16)
593                 return isa_irq_to_vector(gsi);
594
595         return iosapic_register_intr(gsi,
596                                      (polarity ==
597                                       ACPI_ACTIVE_HIGH) ? IOSAPIC_POL_HIGH :
598                                      IOSAPIC_POL_LOW,
599                                      (triggering ==
600                                       ACPI_EDGE_SENSITIVE) ? IOSAPIC_EDGE :
601                                      IOSAPIC_LEVEL);
602 }
603
604 EXPORT_SYMBOL(acpi_register_gsi);
605
606 void acpi_unregister_gsi(u32 gsi)
607 {
608         if (acpi_irq_model == ACPI_IRQ_MODEL_PLATFORM)
609                 return;
610
611         iosapic_unregister_intr(gsi);
612 }
613
614 EXPORT_SYMBOL(acpi_unregister_gsi);
615
616 static int __init acpi_parse_fadt(struct acpi_table_header *table)
617 {
618         struct acpi_table_header *fadt_header;
619         struct acpi_table_fadt *fadt;
620
621         if (!table)
622                 return -EINVAL;
623
624         fadt_header = (struct acpi_table_header *)table;
625         if (fadt_header->revision != 3)
626                 return -ENODEV; /* Only deal with ACPI 2.0 FADT */
627
628         fadt = (struct acpi_table_fadt *)fadt_header;
629
630         acpi_register_gsi(fadt->sci_interrupt, ACPI_LEVEL_SENSITIVE, ACPI_ACTIVE_LOW);
631         return 0;
632 }
633
634 unsigned long __init acpi_find_rsdp(void)
635 {
636         unsigned long rsdp_phys = 0;
637
638         if (efi.acpi20 != EFI_INVALID_TABLE_ADDR)
639                 rsdp_phys = efi.acpi20;
640         else if (efi.acpi != EFI_INVALID_TABLE_ADDR)
641                 printk(KERN_WARNING PREFIX
642                        "v1.0/r0.71 tables no longer supported\n");
643         return rsdp_phys;
644 }
645
646 int __init acpi_boot_init(void)
647 {
648
649         /*
650          * MADT
651          * ----
652          * Parse the Multiple APIC Description Table (MADT), if exists.
653          * Note that this table provides platform SMP configuration
654          * information -- the successor to MPS tables.
655          */
656
657         if (acpi_table_parse(ACPI_SIG_MADT, acpi_parse_madt)) {
658                 printk(KERN_ERR PREFIX "Can't find MADT\n");
659                 goto skip_madt;
660         }
661
662         /* Local APIC */
663
664         if (acpi_table_parse_madt
665             (ACPI_MADT_TYPE_LOCAL_APIC_OVERRIDE, acpi_parse_lapic_addr_ovr, 0) < 0)
666                 printk(KERN_ERR PREFIX
667                        "Error parsing LAPIC address override entry\n");
668
669         if (acpi_table_parse_madt(ACPI_MADT_TYPE_LOCAL_SAPIC, acpi_parse_lsapic, NR_CPUS)
670             < 1)
671                 printk(KERN_ERR PREFIX
672                        "Error parsing MADT - no LAPIC entries\n");
673
674         if (acpi_table_parse_madt(ACPI_MADT_TYPE_LOCAL_APIC_NMI, acpi_parse_lapic_nmi, 0)
675             < 0)
676                 printk(KERN_ERR PREFIX "Error parsing LAPIC NMI entry\n");
677
678         /* I/O APIC */
679
680         if (acpi_table_parse_madt
681             (ACPI_MADT_TYPE_IO_SAPIC, acpi_parse_iosapic, NR_IOSAPICS) < 1) {
682                 if (!ia64_platform_is("sn2"))
683                         printk(KERN_ERR PREFIX
684                                "Error parsing MADT - no IOSAPIC entries\n");
685         }
686
687         /* System-Level Interrupt Routing */
688
689         if (acpi_table_parse_madt
690             (ACPI_MADT_TYPE_INTERRUPT_SOURCE, acpi_parse_plat_int_src,
691              ACPI_MAX_PLATFORM_INTERRUPTS) < 0)
692                 printk(KERN_ERR PREFIX
693                        "Error parsing platform interrupt source entry\n");
694
695         if (acpi_table_parse_madt
696             (ACPI_MADT_TYPE_INTERRUPT_OVERRIDE, acpi_parse_int_src_ovr, 0) < 0)
697                 printk(KERN_ERR PREFIX
698                        "Error parsing interrupt source overrides entry\n");
699
700         if (acpi_table_parse_madt(ACPI_MADT_TYPE_NMI_SOURCE, acpi_parse_nmi_src, 0) < 0)
701                 printk(KERN_ERR PREFIX "Error parsing NMI SRC entry\n");
702       skip_madt:
703
704         /*
705          * FADT says whether a legacy keyboard controller is present.
706          * The FADT also contains an SCI_INT line, by which the system
707          * gets interrupts such as power and sleep buttons.  If it's not
708          * on a Legacy interrupt, it needs to be setup.
709          */
710         if (acpi_table_parse(ACPI_SIG_FADT, acpi_parse_fadt))
711                 printk(KERN_ERR PREFIX "Can't find FADT\n");
712
713 #ifdef CONFIG_SMP
714         if (available_cpus == 0) {
715                 printk(KERN_INFO "ACPI: Found 0 CPUS; assuming 1\n");
716                 printk(KERN_INFO "CPU 0 (0x%04x)", hard_smp_processor_id());
717                 smp_boot_data.cpu_phys_id[available_cpus] =
718                     hard_smp_processor_id();
719                 available_cpus = 1;     /* We've got at least one of these, no? */
720         }
721         smp_boot_data.cpu_count = available_cpus;
722
723         smp_build_cpu_map();
724 # ifdef CONFIG_ACPI_NUMA
725         if (srat_num_cpus == 0) {
726                 int cpu, i = 1;
727                 for (cpu = 0; cpu < smp_boot_data.cpu_count; cpu++)
728                         if (smp_boot_data.cpu_phys_id[cpu] !=
729                             hard_smp_processor_id())
730                                 node_cpuid[i++].phys_id =
731                                     smp_boot_data.cpu_phys_id[cpu];
732         }
733 # endif
734 #endif
735 #ifdef CONFIG_ACPI_NUMA
736         build_cpu_to_node_map();
737 #endif
738         /* Make boot-up look pretty */
739         printk(KERN_INFO "%d CPUs available, %d CPUs total\n", available_cpus,
740                total_cpus);
741         return 0;
742 }
743
744 int acpi_gsi_to_irq(u32 gsi, unsigned int *irq)
745 {
746         int tmp;
747
748         if (has_8259 && gsi < 16)
749                 *irq = isa_irq_to_vector(gsi);
750         else {
751                 tmp = gsi_to_irq(gsi);
752                 if (tmp == -1)
753                         return -1;
754                 *irq = tmp;
755         }
756         return 0;
757 }
758
759 /*
760  *  ACPI based hotplug CPU support
761  */
762 #ifdef CONFIG_ACPI_HOTPLUG_CPU
763 static
764 int acpi_map_cpu2node(acpi_handle handle, int cpu, long physid)
765 {
766 #ifdef CONFIG_ACPI_NUMA
767         int pxm_id;
768         int nid;
769
770         pxm_id = acpi_get_pxm(handle);
771         /*
772          * We don't have cpu-only-node hotadd. But if the system equips
773          * SRAT table, pxm is already found and node is ready.
774          * So, just pxm_to_nid(pxm) is OK.
775          * This code here is for the system which doesn't have full SRAT
776          * table for possible cpus.
777          */
778         nid = acpi_map_pxm_to_node(pxm_id);
779         node_cpuid[cpu].phys_id = physid;
780         node_cpuid[cpu].nid = nid;
781 #endif
782         return (0);
783 }
784
785 int additional_cpus __initdata = -1;
786
787 static __init int setup_additional_cpus(char *s)
788 {
789         if (s)
790                 additional_cpus = simple_strtol(s, NULL, 0);
791
792         return 0;
793 }
794
795 early_param("additional_cpus", setup_additional_cpus);
796
797 /*
798  * cpu_possible_map should be static, it cannot change as CPUs
799  * are onlined, or offlined. The reason is per-cpu data-structures
800  * are allocated by some modules at init time, and dont expect to
801  * do this dynamically on cpu arrival/departure.
802  * cpu_present_map on the other hand can change dynamically.
803  * In case when cpu_hotplug is not compiled, then we resort to current
804  * behaviour, which is cpu_possible == cpu_present.
805  * - Ashok Raj
806  *
807  * Three ways to find out the number of additional hotplug CPUs:
808  * - If the BIOS specified disabled CPUs in ACPI/mptables use that.
809  * - The user can overwrite it with additional_cpus=NUM
810  * - Otherwise don't reserve additional CPUs.
811  */
812 __init void prefill_possible_map(void)
813 {
814         int i;
815         int possible, disabled_cpus;
816
817         disabled_cpus = total_cpus - available_cpus;
818
819         if (additional_cpus == -1) {
820                 if (disabled_cpus > 0)
821                         additional_cpus = disabled_cpus;
822                 else
823                         additional_cpus = 0;
824         }
825
826         possible = available_cpus + additional_cpus;
827
828         if (possible > NR_CPUS)
829                 possible = NR_CPUS;
830
831         printk(KERN_INFO "SMP: Allowing %d CPUs, %d hotplug CPUs\n",
832                 possible, max((possible - available_cpus), 0));
833
834         for (i = 0; i < possible; i++)
835                 cpu_set(i, cpu_possible_map);
836 }
837
838 int acpi_map_lsapic(acpi_handle handle, int *pcpu)
839 {
840         struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };
841         union acpi_object *obj;
842         struct acpi_madt_local_sapic *lsapic;
843         cpumask_t tmp_map;
844         long physid;
845         int cpu;
846
847         if (ACPI_FAILURE(acpi_evaluate_object(handle, "_MAT", NULL, &buffer)))
848                 return -EINVAL;
849
850         if (!buffer.length || !buffer.pointer)
851                 return -EINVAL;
852
853         obj = buffer.pointer;
854         if (obj->type != ACPI_TYPE_BUFFER)
855         {
856                 kfree(buffer.pointer);
857                 return -EINVAL;
858         }
859
860         lsapic = (struct acpi_madt_local_sapic *)obj->buffer.pointer;
861
862         if ((lsapic->header.type != ACPI_MADT_TYPE_LOCAL_SAPIC) ||
863             (!(lsapic->lapic_flags & ACPI_MADT_ENABLED))) {
864                 kfree(buffer.pointer);
865                 return -EINVAL;
866         }
867
868         physid = ((lsapic->id << 8) | (lsapic->eid));
869
870         kfree(buffer.pointer);
871         buffer.length = ACPI_ALLOCATE_BUFFER;
872         buffer.pointer = NULL;
873
874         cpus_complement(tmp_map, cpu_present_map);
875         cpu = first_cpu(tmp_map);
876         if (cpu >= NR_CPUS)
877                 return -EINVAL;
878
879         acpi_map_cpu2node(handle, cpu, physid);
880
881         cpu_set(cpu, cpu_present_map);
882         ia64_cpu_to_sapicid[cpu] = physid;
883
884         *pcpu = cpu;
885         return (0);
886 }
887
888 EXPORT_SYMBOL(acpi_map_lsapic);
889
890 int acpi_unmap_lsapic(int cpu)
891 {
892         ia64_cpu_to_sapicid[cpu] = -1;
893         cpu_clear(cpu, cpu_present_map);
894
895 #ifdef CONFIG_ACPI_NUMA
896         /* NUMA specific cleanup's */
897 #endif
898
899         return (0);
900 }
901
902 EXPORT_SYMBOL(acpi_unmap_lsapic);
903 #endif                          /* CONFIG_ACPI_HOTPLUG_CPU */
904
905 #ifdef CONFIG_ACPI_NUMA
906 static acpi_status __devinit
907 acpi_map_iosapic(acpi_handle handle, u32 depth, void *context, void **ret)
908 {
909         struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };
910         union acpi_object *obj;
911         struct acpi_madt_io_sapic *iosapic;
912         unsigned int gsi_base;
913         int pxm, node;
914
915         /* Only care about objects w/ a method that returns the MADT */
916         if (ACPI_FAILURE(acpi_evaluate_object(handle, "_MAT", NULL, &buffer)))
917                 return AE_OK;
918
919         if (!buffer.length || !buffer.pointer)
920                 return AE_OK;
921
922         obj = buffer.pointer;
923         if (obj->type != ACPI_TYPE_BUFFER ||
924             obj->buffer.length < sizeof(*iosapic)) {
925                 kfree(buffer.pointer);
926                 return AE_OK;
927         }
928
929         iosapic = (struct acpi_madt_io_sapic *)obj->buffer.pointer;
930
931         if (iosapic->header.type != ACPI_MADT_TYPE_IO_SAPIC) {
932                 kfree(buffer.pointer);
933                 return AE_OK;
934         }
935
936         gsi_base = iosapic->global_irq_base;
937
938         kfree(buffer.pointer);
939
940         /*
941          * OK, it's an IOSAPIC MADT entry, look for a _PXM value to tell
942          * us which node to associate this with.
943          */
944         pxm = acpi_get_pxm(handle);
945         if (pxm < 0)
946                 return AE_OK;
947
948         node = pxm_to_node(pxm);
949
950         if (node >= MAX_NUMNODES || !node_online(node) ||
951             cpus_empty(node_to_cpumask(node)))
952                 return AE_OK;
953
954         /* We know a gsi to node mapping! */
955         map_iosapic_to_node(gsi_base, node);
956         return AE_OK;
957 }
958
959 static int __init
960 acpi_map_iosapics (void)
961 {
962         acpi_get_devices(NULL, acpi_map_iosapic, NULL, NULL);
963         return 0;
964 }
965
966 fs_initcall(acpi_map_iosapics);
967 #endif                          /* CONFIG_ACPI_NUMA */
968
969 int acpi_register_ioapic(acpi_handle handle, u64 phys_addr, u32 gsi_base)
970 {
971         int err;
972
973         if ((err = iosapic_init(phys_addr, gsi_base)))
974                 return err;
975
976 #ifdef CONFIG_ACPI_NUMA
977         acpi_map_iosapic(handle, 0, NULL, NULL);
978 #endif                          /* CONFIG_ACPI_NUMA */
979
980         return 0;
981 }
982
983 EXPORT_SYMBOL(acpi_register_ioapic);
984
985 int acpi_unregister_ioapic(acpi_handle handle, u32 gsi_base)
986 {
987         return iosapic_remove(gsi_base);
988 }
989
990 EXPORT_SYMBOL(acpi_unregister_ioapic);
991
992 /*
993  * acpi_save_state_mem() - save kernel state
994  *
995  * TBD when when IA64 starts to support suspend...
996  */
997 int acpi_save_state_mem(void) { return 0; } 
998
999 /*
1000  * acpi_restore_state()
1001  */
1002 void acpi_restore_state_mem(void) {}
1003
1004 /*
1005  * do_suspend_lowlevel()
1006  */
1007 void do_suspend_lowlevel(void) {}
1008
1009 #endif                          /* CONFIG_ACPI */