| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1 | /* | 
|  | 2 | *  acpi_tables.c - ACPI Boot-Time Table Parsing | 
|  | 3 | * | 
|  | 4 | *  Copyright (C) 2001 Paul Diefenbaugh <paul.s.diefenbaugh@intel.com> | 
|  | 5 | * | 
|  | 6 | * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~ | 
|  | 7 | * | 
|  | 8 | *  This program is free software; you can redistribute it and/or modify | 
|  | 9 | *  it under the terms of the GNU General Public License as published by | 
|  | 10 | *  the Free Software Foundation; either version 2 of the License, or | 
|  | 11 | *  (at your option) any later version. | 
|  | 12 | * | 
|  | 13 | *  This program is distributed in the hope that it will be useful, | 
|  | 14 | *  but WITHOUT ANY WARRANTY; without even the implied warranty of | 
|  | 15 | *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the | 
|  | 16 | *  GNU General Public License for more details. | 
|  | 17 | * | 
|  | 18 | *  You should have received a copy of the GNU General Public License | 
|  | 19 | *  along with this program; if not, write to the Free Software | 
|  | 20 | *  Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA | 
|  | 21 | * | 
|  | 22 | * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~ | 
|  | 23 | * | 
|  | 24 | */ | 
|  | 25 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 26 | #include <linux/init.h> | 
|  | 27 | #include <linux/kernel.h> | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 28 | #include <linux/smp.h> | 
|  | 29 | #include <linux/string.h> | 
|  | 30 | #include <linux/types.h> | 
|  | 31 | #include <linux/irq.h> | 
|  | 32 | #include <linux/errno.h> | 
|  | 33 | #include <linux/acpi.h> | 
|  | 34 | #include <linux/bootmem.h> | 
|  | 35 |  | 
|  | 36 | #define PREFIX			"ACPI: " | 
|  | 37 |  | 
| Len Brown | 04348e6 | 2005-12-30 02:44:59 -0500 | [diff] [blame] | 38 | #define ACPI_MAX_TABLES		128 | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 39 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 40 | static char *mps_inti_flags_polarity[] = { "dfl", "high", "res", "low" }; | 
|  | 41 | static char *mps_inti_flags_trigger[] = { "dfl", "edge", "res", "level" }; | 
|  | 42 |  | 
| Alexey Starikovskiy | ad71860 | 2007-02-02 19:48:19 +0300 | [diff] [blame] | 43 | static struct acpi_table_desc initial_tables[ACPI_MAX_TABLES] __initdata; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 44 |  | 
| Len Brown | 4e381a4 | 2007-03-30 14:16:10 -0400 | [diff] [blame] | 45 | static int acpi_apic_instance __initdata; | 
| Len Brown | a1fdcc0 | 2007-03-11 03:26:14 -0400 | [diff] [blame] | 46 |  | 
|  | 47 | void acpi_table_print_madt_entry(struct acpi_subtable_header *header) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 48 | { | 
|  | 49 | if (!header) | 
|  | 50 | return; | 
|  | 51 |  | 
|  | 52 | switch (header->type) { | 
|  | 53 |  | 
| Alexey Starikovskiy | 5f3b1a8 | 2007-02-02 19:48:22 +0300 | [diff] [blame] | 54 | case ACPI_MADT_TYPE_LOCAL_APIC: | 
| Len Brown | 4be44fc | 2005-08-05 00:44:28 -0400 | [diff] [blame] | 55 | { | 
| Alexey Starikovskiy | 5f3b1a8 | 2007-02-02 19:48:22 +0300 | [diff] [blame] | 56 | struct acpi_madt_local_apic *p = | 
|  | 57 | (struct acpi_madt_local_apic *)header; | 
| Len Brown | 4be44fc | 2005-08-05 00:44:28 -0400 | [diff] [blame] | 58 | printk(KERN_INFO PREFIX | 
|  | 59 | "LAPIC (acpi_id[0x%02x] lapic_id[0x%02x] %s)\n", | 
| Alexey Starikovskiy | 5f3b1a8 | 2007-02-02 19:48:22 +0300 | [diff] [blame] | 60 | p->processor_id, p->id, | 
|  | 61 | (p->lapic_flags & ACPI_MADT_ENABLED) ? "enabled" : "disabled"); | 
| Len Brown | 4be44fc | 2005-08-05 00:44:28 -0400 | [diff] [blame] | 62 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 63 | break; | 
|  | 64 |  | 
| Suresh Siddha | 7237d3d | 2009-03-30 13:55:30 -0800 | [diff] [blame] | 65 | case ACPI_MADT_TYPE_LOCAL_X2APIC: | 
|  | 66 | { | 
|  | 67 | struct acpi_madt_local_x2apic *p = | 
|  | 68 | (struct acpi_madt_local_x2apic *)header; | 
|  | 69 | printk(KERN_INFO PREFIX | 
|  | 70 | "X2APIC (apic_id[0x%02x] uid[0x%02x] %s)\n", | 
|  | 71 | p->local_apic_id, p->uid, | 
|  | 72 | (p->lapic_flags & ACPI_MADT_ENABLED) ? | 
|  | 73 | "enabled" : "disabled"); | 
|  | 74 | } | 
|  | 75 | break; | 
|  | 76 |  | 
| Alexey Starikovskiy | 5f3b1a8 | 2007-02-02 19:48:22 +0300 | [diff] [blame] | 77 | case ACPI_MADT_TYPE_IO_APIC: | 
| Len Brown | 4be44fc | 2005-08-05 00:44:28 -0400 | [diff] [blame] | 78 | { | 
| Alexey Starikovskiy | 5f3b1a8 | 2007-02-02 19:48:22 +0300 | [diff] [blame] | 79 | struct acpi_madt_io_apic *p = | 
|  | 80 | (struct acpi_madt_io_apic *)header; | 
| Len Brown | 4be44fc | 2005-08-05 00:44:28 -0400 | [diff] [blame] | 81 | printk(KERN_INFO PREFIX | 
|  | 82 | "IOAPIC (id[0x%02x] address[0x%08x] gsi_base[%d])\n", | 
|  | 83 | p->id, p->address, p->global_irq_base); | 
|  | 84 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 85 | break; | 
|  | 86 |  | 
| Alexey Starikovskiy | 5f3b1a8 | 2007-02-02 19:48:22 +0300 | [diff] [blame] | 87 | case ACPI_MADT_TYPE_INTERRUPT_OVERRIDE: | 
| Len Brown | 4be44fc | 2005-08-05 00:44:28 -0400 | [diff] [blame] | 88 | { | 
| Alexey Starikovskiy | 5f3b1a8 | 2007-02-02 19:48:22 +0300 | [diff] [blame] | 89 | struct acpi_madt_interrupt_override *p = | 
|  | 90 | (struct acpi_madt_interrupt_override *)header; | 
| Len Brown | 4be44fc | 2005-08-05 00:44:28 -0400 | [diff] [blame] | 91 | printk(KERN_INFO PREFIX | 
|  | 92 | "INT_SRC_OVR (bus %d bus_irq %d global_irq %d %s %s)\n", | 
| Alexey Starikovskiy | 5f3b1a8 | 2007-02-02 19:48:22 +0300 | [diff] [blame] | 93 | p->bus, p->source_irq, p->global_irq, | 
|  | 94 | mps_inti_flags_polarity[p->inti_flags & ACPI_MADT_POLARITY_MASK], | 
|  | 95 | mps_inti_flags_trigger[(p->inti_flags & ACPI_MADT_TRIGGER_MASK) >> 2]); | 
|  | 96 | if (p->inti_flags  & | 
|  | 97 | ~(ACPI_MADT_POLARITY_MASK | ACPI_MADT_TRIGGER_MASK)) | 
| Len Brown | 4be44fc | 2005-08-05 00:44:28 -0400 | [diff] [blame] | 98 | printk(KERN_INFO PREFIX | 
|  | 99 | "INT_SRC_OVR unexpected reserved flags: 0x%x\n", | 
| Alexey Starikovskiy | 5f3b1a8 | 2007-02-02 19:48:22 +0300 | [diff] [blame] | 100 | p->inti_flags  & | 
|  | 101 | ~(ACPI_MADT_POLARITY_MASK | ACPI_MADT_TRIGGER_MASK)); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 102 |  | 
| Len Brown | 4be44fc | 2005-08-05 00:44:28 -0400 | [diff] [blame] | 103 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 104 | break; | 
|  | 105 |  | 
| Alexey Starikovskiy | 5f3b1a8 | 2007-02-02 19:48:22 +0300 | [diff] [blame] | 106 | case ACPI_MADT_TYPE_NMI_SOURCE: | 
| Len Brown | 4be44fc | 2005-08-05 00:44:28 -0400 | [diff] [blame] | 107 | { | 
| Alexey Starikovskiy | 5f3b1a8 | 2007-02-02 19:48:22 +0300 | [diff] [blame] | 108 | struct acpi_madt_nmi_source *p = | 
|  | 109 | (struct acpi_madt_nmi_source *)header; | 
| Len Brown | 4be44fc | 2005-08-05 00:44:28 -0400 | [diff] [blame] | 110 | printk(KERN_INFO PREFIX | 
|  | 111 | "NMI_SRC (%s %s global_irq %d)\n", | 
| Alexey Starikovskiy | 5f3b1a8 | 2007-02-02 19:48:22 +0300 | [diff] [blame] | 112 | mps_inti_flags_polarity[p->inti_flags & ACPI_MADT_POLARITY_MASK], | 
|  | 113 | mps_inti_flags_trigger[(p->inti_flags & ACPI_MADT_TRIGGER_MASK) >> 2], | 
| Len Brown | 4be44fc | 2005-08-05 00:44:28 -0400 | [diff] [blame] | 114 | p->global_irq); | 
|  | 115 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 116 | break; | 
|  | 117 |  | 
| Alexey Starikovskiy | 5f3b1a8 | 2007-02-02 19:48:22 +0300 | [diff] [blame] | 118 | case ACPI_MADT_TYPE_LOCAL_APIC_NMI: | 
| Len Brown | 4be44fc | 2005-08-05 00:44:28 -0400 | [diff] [blame] | 119 | { | 
| Alexey Starikovskiy | 5f3b1a8 | 2007-02-02 19:48:22 +0300 | [diff] [blame] | 120 | struct acpi_madt_local_apic_nmi *p = | 
|  | 121 | (struct acpi_madt_local_apic_nmi *)header; | 
| Len Brown | 4be44fc | 2005-08-05 00:44:28 -0400 | [diff] [blame] | 122 | printk(KERN_INFO PREFIX | 
|  | 123 | "LAPIC_NMI (acpi_id[0x%02x] %s %s lint[0x%x])\n", | 
| Alexey Starikovskiy | 5f3b1a8 | 2007-02-02 19:48:22 +0300 | [diff] [blame] | 124 | p->processor_id, | 
|  | 125 | mps_inti_flags_polarity[p->inti_flags & ACPI_MADT_POLARITY_MASK	], | 
|  | 126 | mps_inti_flags_trigger[(p->inti_flags & ACPI_MADT_TRIGGER_MASK) >> 2], | 
| Len Brown | 4be44fc | 2005-08-05 00:44:28 -0400 | [diff] [blame] | 127 | p->lint); | 
|  | 128 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 129 | break; | 
|  | 130 |  | 
| Suresh Siddha | 7237d3d | 2009-03-30 13:55:30 -0800 | [diff] [blame] | 131 | case ACPI_MADT_TYPE_LOCAL_X2APIC_NMI: | 
|  | 132 | { | 
|  | 133 | u16 polarity, trigger; | 
|  | 134 | struct acpi_madt_local_x2apic_nmi *p = | 
|  | 135 | (struct acpi_madt_local_x2apic_nmi *)header; | 
|  | 136 |  | 
|  | 137 | polarity = p->inti_flags & ACPI_MADT_POLARITY_MASK; | 
|  | 138 | trigger = (p->inti_flags & ACPI_MADT_TRIGGER_MASK) >> 2; | 
|  | 139 |  | 
|  | 140 | printk(KERN_INFO PREFIX | 
|  | 141 | "X2APIC_NMI (uid[0x%02x] %s %s lint[0x%x])\n", | 
|  | 142 | p->uid, | 
|  | 143 | mps_inti_flags_polarity[polarity], | 
|  | 144 | mps_inti_flags_trigger[trigger], | 
|  | 145 | p->lint); | 
|  | 146 | } | 
|  | 147 | break; | 
|  | 148 |  | 
| Alexey Starikovskiy | 5f3b1a8 | 2007-02-02 19:48:22 +0300 | [diff] [blame] | 149 | case ACPI_MADT_TYPE_LOCAL_APIC_OVERRIDE: | 
| Len Brown | 4be44fc | 2005-08-05 00:44:28 -0400 | [diff] [blame] | 150 | { | 
| Alexey Starikovskiy | 5f3b1a8 | 2007-02-02 19:48:22 +0300 | [diff] [blame] | 151 | struct acpi_madt_local_apic_override *p = | 
|  | 152 | (struct acpi_madt_local_apic_override *)header; | 
| Len Brown | 4be44fc | 2005-08-05 00:44:28 -0400 | [diff] [blame] | 153 | printk(KERN_INFO PREFIX | 
|  | 154 | "LAPIC_ADDR_OVR (address[%p])\n", | 
|  | 155 | (void *)(unsigned long)p->address); | 
|  | 156 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 157 | break; | 
|  | 158 |  | 
| Alexey Starikovskiy | 5f3b1a8 | 2007-02-02 19:48:22 +0300 | [diff] [blame] | 159 | case ACPI_MADT_TYPE_IO_SAPIC: | 
| Len Brown | 4be44fc | 2005-08-05 00:44:28 -0400 | [diff] [blame] | 160 | { | 
| Alexey Starikovskiy | 5f3b1a8 | 2007-02-02 19:48:22 +0300 | [diff] [blame] | 161 | struct acpi_madt_io_sapic *p = | 
|  | 162 | (struct acpi_madt_io_sapic *)header; | 
| Len Brown | 4be44fc | 2005-08-05 00:44:28 -0400 | [diff] [blame] | 163 | printk(KERN_INFO PREFIX | 
|  | 164 | "IOSAPIC (id[0x%x] address[%p] gsi_base[%d])\n", | 
|  | 165 | p->id, (void *)(unsigned long)p->address, | 
|  | 166 | p->global_irq_base); | 
|  | 167 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 168 | break; | 
|  | 169 |  | 
| Alexey Starikovskiy | 5f3b1a8 | 2007-02-02 19:48:22 +0300 | [diff] [blame] | 170 | case ACPI_MADT_TYPE_LOCAL_SAPIC: | 
| Len Brown | 4be44fc | 2005-08-05 00:44:28 -0400 | [diff] [blame] | 171 | { | 
| Alexey Starikovskiy | 5f3b1a8 | 2007-02-02 19:48:22 +0300 | [diff] [blame] | 172 | struct acpi_madt_local_sapic *p = | 
|  | 173 | (struct acpi_madt_local_sapic *)header; | 
| Len Brown | 4be44fc | 2005-08-05 00:44:28 -0400 | [diff] [blame] | 174 | printk(KERN_INFO PREFIX | 
|  | 175 | "LSAPIC (acpi_id[0x%02x] lsapic_id[0x%02x] lsapic_eid[0x%02x] %s)\n", | 
| Alexey Starikovskiy | 5f3b1a8 | 2007-02-02 19:48:22 +0300 | [diff] [blame] | 176 | p->processor_id, p->id, p->eid, | 
|  | 177 | (p->lapic_flags & ACPI_MADT_ENABLED) ? "enabled" : "disabled"); | 
| Len Brown | 4be44fc | 2005-08-05 00:44:28 -0400 | [diff] [blame] | 178 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 179 | break; | 
|  | 180 |  | 
| Alexey Starikovskiy | 5f3b1a8 | 2007-02-02 19:48:22 +0300 | [diff] [blame] | 181 | case ACPI_MADT_TYPE_INTERRUPT_SOURCE: | 
| Len Brown | 4be44fc | 2005-08-05 00:44:28 -0400 | [diff] [blame] | 182 | { | 
| Alexey Starikovskiy | 5f3b1a8 | 2007-02-02 19:48:22 +0300 | [diff] [blame] | 183 | struct acpi_madt_interrupt_source *p = | 
|  | 184 | (struct acpi_madt_interrupt_source *)header; | 
| Len Brown | 4be44fc | 2005-08-05 00:44:28 -0400 | [diff] [blame] | 185 | printk(KERN_INFO PREFIX | 
|  | 186 | "PLAT_INT_SRC (%s %s type[0x%x] id[0x%04x] eid[0x%x] iosapic_vector[0x%x] global_irq[0x%x]\n", | 
| Alexey Starikovskiy | 5f3b1a8 | 2007-02-02 19:48:22 +0300 | [diff] [blame] | 187 | mps_inti_flags_polarity[p->inti_flags & ACPI_MADT_POLARITY_MASK], | 
|  | 188 | mps_inti_flags_trigger[(p->inti_flags & ACPI_MADT_TRIGGER_MASK) >> 2], | 
|  | 189 | p->type, p->id, p->eid, p->io_sapic_vector, | 
| Len Brown | 4be44fc | 2005-08-05 00:44:28 -0400 | [diff] [blame] | 190 | p->global_irq); | 
|  | 191 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 192 | break; | 
|  | 193 |  | 
|  | 194 | default: | 
| Len Brown | 4be44fc | 2005-08-05 00:44:28 -0400 | [diff] [blame] | 195 | printk(KERN_WARNING PREFIX | 
|  | 196 | "Found unsupported MADT entry (type = 0x%x)\n", | 
|  | 197 | header->type); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 198 | break; | 
|  | 199 | } | 
|  | 200 | } | 
|  | 201 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 202 |  | 
|  | 203 | int __init | 
| Len Brown | 6eb87fe | 2007-02-10 22:17:07 -0500 | [diff] [blame] | 204 | acpi_table_parse_entries(char *id, | 
|  | 205 | unsigned long table_size, | 
| Len Brown | 4be44fc | 2005-08-05 00:44:28 -0400 | [diff] [blame] | 206 | int entry_id, | 
| Len Brown | 5a8765a | 2007-02-10 21:35:47 -0500 | [diff] [blame] | 207 | acpi_table_entry_handler handler, | 
| Len Brown | 4be44fc | 2005-08-05 00:44:28 -0400 | [diff] [blame] | 208 | unsigned int max_entries) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 209 | { | 
| Len Brown | 6eb87fe | 2007-02-10 22:17:07 -0500 | [diff] [blame] | 210 | struct acpi_table_header *table_header = NULL; | 
| Alexey Starikovskiy | 5f3b1a8 | 2007-02-02 19:48:22 +0300 | [diff] [blame] | 211 | struct acpi_subtable_header *entry; | 
| Len Brown | 4be44fc | 2005-08-05 00:44:28 -0400 | [diff] [blame] | 212 | unsigned int count = 0; | 
| Len Brown | 6eb87fe | 2007-02-10 22:17:07 -0500 | [diff] [blame] | 213 | unsigned long table_end; | 
| Yinghai Lu | 7d97277 | 2009-02-07 15:39:41 -0800 | [diff] [blame] | 214 | acpi_size tbl_size; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 215 |  | 
| Len Brown | 68ca406 | 2010-02-19 00:09:22 -0500 | [diff] [blame] | 216 | if (acpi_disabled) | 
| Len Brown | e5b8fc6 | 2009-07-07 23:22:58 -0400 | [diff] [blame] | 217 | return -ENODEV; | 
|  | 218 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 219 | if (!handler) | 
|  | 220 | return -EINVAL; | 
|  | 221 |  | 
| Len Brown | a1fdcc0 | 2007-03-11 03:26:14 -0400 | [diff] [blame] | 222 | if (strncmp(id, ACPI_SIG_MADT, 4) == 0) | 
| Yinghai Lu | 7d97277 | 2009-02-07 15:39:41 -0800 | [diff] [blame] | 223 | acpi_get_table_with_size(id, acpi_apic_instance, &table_header, &tbl_size); | 
| Len Brown | a1fdcc0 | 2007-03-11 03:26:14 -0400 | [diff] [blame] | 224 | else | 
| Yinghai Lu | 7d97277 | 2009-02-07 15:39:41 -0800 | [diff] [blame] | 225 | acpi_get_table_with_size(id, 0, &table_header, &tbl_size); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 226 |  | 
| Len Brown | 6eb87fe | 2007-02-10 22:17:07 -0500 | [diff] [blame] | 227 | if (!table_header) { | 
| Alexey Starikovskiy | ceb6c46 | 2007-02-02 19:48:22 +0300 | [diff] [blame] | 228 | printk(KERN_WARNING PREFIX "%4.4s not present\n", id); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 229 | return -ENODEV; | 
|  | 230 | } | 
|  | 231 |  | 
| Len Brown | 6eb87fe | 2007-02-10 22:17:07 -0500 | [diff] [blame] | 232 | table_end = (unsigned long)table_header + table_header->length; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 233 |  | 
|  | 234 | /* Parse all entries looking for a match. */ | 
|  | 235 |  | 
| Alexey Starikovskiy | 5f3b1a8 | 2007-02-02 19:48:22 +0300 | [diff] [blame] | 236 | entry = (struct acpi_subtable_header *) | 
| Len Brown | 6eb87fe | 2007-02-10 22:17:07 -0500 | [diff] [blame] | 237 | ((unsigned long)table_header + table_size); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 238 |  | 
| Alexey Starikovskiy | 5f3b1a8 | 2007-02-02 19:48:22 +0300 | [diff] [blame] | 239 | while (((unsigned long)entry) + sizeof(struct acpi_subtable_header) < | 
| Len Brown | 6eb87fe | 2007-02-10 22:17:07 -0500 | [diff] [blame] | 240 | table_end) { | 
| Len Brown | 4be44fc | 2005-08-05 00:44:28 -0400 | [diff] [blame] | 241 | if (entry->type == entry_id | 
|  | 242 | && (!max_entries || count++ < max_entries)) | 
| Yinghai Lu | 7d97277 | 2009-02-07 15:39:41 -0800 | [diff] [blame] | 243 | if (handler(entry, table_end)) { | 
|  | 244 | early_acpi_os_unmap_memory((char *)table_header, tbl_size); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 245 | return -EINVAL; | 
| Yinghai Lu | 7d97277 | 2009-02-07 15:39:41 -0800 | [diff] [blame] | 246 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 247 |  | 
| Alexey Starikovskiy | 5f3b1a8 | 2007-02-02 19:48:22 +0300 | [diff] [blame] | 248 | entry = (struct acpi_subtable_header *) | 
| Len Brown | 4be44fc | 2005-08-05 00:44:28 -0400 | [diff] [blame] | 249 | ((unsigned long)entry + entry->length); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 250 | } | 
|  | 251 | if (max_entries && count > max_entries) { | 
| Alexey Starikovskiy | ceb6c46 | 2007-02-02 19:48:22 +0300 | [diff] [blame] | 252 | printk(KERN_WARNING PREFIX "[%4.4s:0x%02x] ignored %i entries of " | 
|  | 253 | "%i found\n", id, entry_id, count - max_entries, count); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 254 | } | 
|  | 255 |  | 
| Yinghai Lu | 7d97277 | 2009-02-07 15:39:41 -0800 | [diff] [blame] | 256 | early_acpi_os_unmap_memory((char *)table_header, tbl_size); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 257 | return count; | 
|  | 258 | } | 
|  | 259 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 260 | int __init | 
| Alexey Starikovskiy | 5f3b1a8 | 2007-02-02 19:48:22 +0300 | [diff] [blame] | 261 | acpi_table_parse_madt(enum acpi_madt_type id, | 
| Len Brown | 5a8765a | 2007-02-10 21:35:47 -0500 | [diff] [blame] | 262 | acpi_table_entry_handler handler, unsigned int max_entries) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 263 | { | 
| Len Brown | 6eb87fe | 2007-02-10 22:17:07 -0500 | [diff] [blame] | 264 | return acpi_table_parse_entries(ACPI_SIG_MADT, | 
| Len Brown | 4be44fc | 2005-08-05 00:44:28 -0400 | [diff] [blame] | 265 | sizeof(struct acpi_table_madt), id, | 
|  | 266 | handler, max_entries); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 267 | } | 
|  | 268 |  | 
| Len Brown | 7f8f97c | 2007-02-10 21:28:03 -0500 | [diff] [blame] | 269 | /** | 
|  | 270 | * acpi_table_parse - find table with @id, run @handler on it | 
|  | 271 | * | 
|  | 272 | * @id: table id to find | 
|  | 273 | * @handler: handler to run | 
|  | 274 | * | 
|  | 275 | * Scan the ACPI System Descriptor Table (STD) for a table matching @id, | 
|  | 276 | * run @handler on it.  Return 0 if table found, return on if not. | 
|  | 277 | */ | 
| Alexey Starikovskiy | ceb6c46 | 2007-02-02 19:48:22 +0300 | [diff] [blame] | 278 | int __init acpi_table_parse(char *id, acpi_table_handler handler) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 279 | { | 
| Alexey Starikovskiy | ceb6c46 | 2007-02-02 19:48:22 +0300 | [diff] [blame] | 280 | struct acpi_table_header *table = NULL; | 
| Yinghai Lu | 7d97277 | 2009-02-07 15:39:41 -0800 | [diff] [blame] | 281 | acpi_size tbl_size; | 
| Len Brown | a1fdcc0 | 2007-03-11 03:26:14 -0400 | [diff] [blame] | 282 |  | 
| Len Brown | 68ca406 | 2010-02-19 00:09:22 -0500 | [diff] [blame] | 283 | if (acpi_disabled) | 
| Len Brown | e5b8fc6 | 2009-07-07 23:22:58 -0400 | [diff] [blame] | 284 | return -ENODEV; | 
|  | 285 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 286 | if (!handler) | 
|  | 287 | return -EINVAL; | 
|  | 288 |  | 
| Len Brown | a1fdcc0 | 2007-03-11 03:26:14 -0400 | [diff] [blame] | 289 | if (strncmp(id, ACPI_SIG_MADT, 4) == 0) | 
| Yinghai Lu | 7d97277 | 2009-02-07 15:39:41 -0800 | [diff] [blame] | 290 | acpi_get_table_with_size(id, acpi_apic_instance, &table, &tbl_size); | 
| Len Brown | a1fdcc0 | 2007-03-11 03:26:14 -0400 | [diff] [blame] | 291 | else | 
| Yinghai Lu | 7d97277 | 2009-02-07 15:39:41 -0800 | [diff] [blame] | 292 | acpi_get_table_with_size(id, 0, &table, &tbl_size); | 
| Len Brown | a1fdcc0 | 2007-03-11 03:26:14 -0400 | [diff] [blame] | 293 |  | 
| Alexey Starikovskiy | ceb6c46 | 2007-02-02 19:48:22 +0300 | [diff] [blame] | 294 | if (table) { | 
|  | 295 | handler(table); | 
| Yinghai Lu | 7d97277 | 2009-02-07 15:39:41 -0800 | [diff] [blame] | 296 | early_acpi_os_unmap_memory(table, tbl_size); | 
| Alexey Starikovskiy | ceb6c46 | 2007-02-02 19:48:22 +0300 | [diff] [blame] | 297 | return 0; | 
| Len Brown | 7f8f97c | 2007-02-10 21:28:03 -0500 | [diff] [blame] | 298 | } else | 
|  | 299 | return 1; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 300 | } | 
|  | 301 |  | 
| Len Brown | a1fdcc0 | 2007-03-11 03:26:14 -0400 | [diff] [blame] | 302 | /* | 
|  | 303 | * The BIOS is supposed to supply a single APIC/MADT, | 
|  | 304 | * but some report two.  Provide a knob to use either. | 
|  | 305 | * (don't you wish instance 0 and 1 were not the same?) | 
|  | 306 | */ | 
|  | 307 | static void __init check_multiple_madt(void) | 
|  | 308 | { | 
|  | 309 | struct acpi_table_header *table = NULL; | 
| Yinghai Lu | 7d97277 | 2009-02-07 15:39:41 -0800 | [diff] [blame] | 310 | acpi_size tbl_size; | 
| Len Brown | a1fdcc0 | 2007-03-11 03:26:14 -0400 | [diff] [blame] | 311 |  | 
| Yinghai Lu | 7d97277 | 2009-02-07 15:39:41 -0800 | [diff] [blame] | 312 | acpi_get_table_with_size(ACPI_SIG_MADT, 2, &table, &tbl_size); | 
| Len Brown | a1fdcc0 | 2007-03-11 03:26:14 -0400 | [diff] [blame] | 313 | if (table) { | 
|  | 314 | printk(KERN_WARNING PREFIX | 
|  | 315 | "BIOS bug: multiple APIC/MADT found," | 
|  | 316 | " using %d\n", acpi_apic_instance); | 
|  | 317 | printk(KERN_WARNING PREFIX | 
|  | 318 | "If \"acpi_apic_instance=%d\" works better, " | 
|  | 319 | "notify linux-acpi@vger.kernel.org\n", | 
|  | 320 | acpi_apic_instance ? 0 : 2); | 
| Yinghai Lu | 7d97277 | 2009-02-07 15:39:41 -0800 | [diff] [blame] | 321 | early_acpi_os_unmap_memory(table, tbl_size); | 
| Len Brown | a1fdcc0 | 2007-03-11 03:26:14 -0400 | [diff] [blame] | 322 |  | 
|  | 323 | } else | 
|  | 324 | acpi_apic_instance = 0; | 
|  | 325 |  | 
|  | 326 | return; | 
|  | 327 | } | 
|  | 328 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 329 | /* | 
|  | 330 | * acpi_table_init() | 
|  | 331 | * | 
|  | 332 | * find RSDP, find and checksum SDT/XSDT. | 
|  | 333 | * checksum all tables, print SDT/XSDT | 
| Alexey Starikovskiy | 5f3b1a8 | 2007-02-02 19:48:22 +0300 | [diff] [blame] | 334 | * | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 335 | * result: sdt_entry[] is initialized | 
|  | 336 | */ | 
|  | 337 |  | 
| Len Brown | 4be44fc | 2005-08-05 00:44:28 -0400 | [diff] [blame] | 338 | int __init acpi_table_init(void) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 339 | { | 
| Len Brown | 9e3a9d1 | 2009-02-06 14:00:56 -0500 | [diff] [blame] | 340 | acpi_status status; | 
|  | 341 |  | 
|  | 342 | status = acpi_initialize_tables(initial_tables, ACPI_MAX_TABLES, 0); | 
|  | 343 | if (ACPI_FAILURE(status)) | 
|  | 344 | return 1; | 
|  | 345 |  | 
| Len Brown | a1fdcc0 | 2007-03-11 03:26:14 -0400 | [diff] [blame] | 346 | check_multiple_madt(); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 347 | return 0; | 
|  | 348 | } | 
| Len Brown | a1fdcc0 | 2007-03-11 03:26:14 -0400 | [diff] [blame] | 349 |  | 
|  | 350 | static int __init acpi_parse_apic_instance(char *str) | 
|  | 351 | { | 
| Cyrill Gorcunov | f0df2d6 | 2008-08-20 16:41:45 -0700 | [diff] [blame] | 352 | if (!str) | 
|  | 353 | return -EINVAL; | 
| Len Brown | a1fdcc0 | 2007-03-11 03:26:14 -0400 | [diff] [blame] | 354 |  | 
|  | 355 | acpi_apic_instance = simple_strtoul(str, NULL, 0); | 
|  | 356 |  | 
|  | 357 | printk(KERN_NOTICE PREFIX "Shall use APIC/MADT table %d\n", | 
|  | 358 | acpi_apic_instance); | 
|  | 359 |  | 
|  | 360 | return 0; | 
|  | 361 | } | 
|  | 362 |  | 
|  | 363 | early_param("acpi_apic_instance", acpi_parse_apic_instance); |