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