SAFE public projects git trees. - safe/jmp/linux-2.6/blob - arch/x86/kernel/mpparse.c

   1 /*
   2  *      Intel Multiprocessor Specification 1.1 and 1.4
   3  *      compliant MP-table parsing routines.
   4  *
   5  *      (c) 1995 Alan Cox, Building #3 <alan@redhat.com>
   6  *      (c) 1998, 1999, 2000 Ingo Molnar <mingo@redhat.com>
   7  *      (c) 2008 Alexey Starikovskiy <astarikovskiy@suse.de>
   8  */
   9
  10 #include <linux/mm.h>
  11 #include <linux/init.h>
  12 #include <linux/delay.h>
  13 #include <linux/bootmem.h>
  14 #include <linux/kernel_stat.h>
  15 #include <linux/mc146818rtc.h>
  16 #include <linux/bitops.h>
  17 #include <linux/acpi.h>
  18 #include <linux/module.h>
  19
  20 #include <asm/smp.h>
  21 #include <asm/mtrr.h>
  22 #include <asm/mpspec.h>
  23 #include <asm/pgalloc.h>
  24 #include <asm/io_apic.h>
  25 #include <asm/proto.h>
  26 #include <asm/acpi.h>
  27 #include <asm/bios_ebda.h>
  28 #include <asm/e820.h>
  29 #include <asm/trampoline.h>
  30
  31 #include <mach_apic.h>
  32 #ifdef CONFIG_X86_32
  33 #include <mach_apicdef.h>
  34 #include <mach_mpparse.h>
  35 #endif
  36
  37 /*
  38  * Checksum an MP configuration block.
  39  */
  40
  41 static int __init mpf_checksum(unsigned char *mp, int len)
  42 {
  43         int sum = 0;
  44
  45         while (len--)
  46                 sum += *mp++;
  47
  48         return sum & 0xFF;
  49 }
  50
  51 #ifdef CONFIG_X86_NUMAQ
  52 int found_numaq;
  53 /*
  54  * Have to match translation table entries to main table entries by counter
  55  * hence the mpc_record variable .... can't see a less disgusting way of
  56  * doing this ....
  57  */
  58 struct mpc_config_translation {
  59         unsigned char mpc_type;
  60         unsigned char trans_len;
  61         unsigned char trans_type;
  62         unsigned char trans_quad;
  63         unsigned char trans_global;
  64         unsigned char trans_local;
  65         unsigned short trans_reserved;
  66 };
  67
  68
  69 static int mpc_record;
  70 static struct mpc_config_translation *translation_table[MAX_MPC_ENTRY]
  71     __cpuinitdata;
  72
  73 static inline int generate_logical_apicid(int quad, int phys_apicid)
  74 {
  75         return (quad << 4) + (phys_apicid ? phys_apicid << 1 : 1);
  76 }
  77
  78
  79 static inline int mpc_apic_id(struct mpc_config_processor *m,
  80                         struct mpc_config_translation *translation_record)
  81 {
  82         int quad = translation_record->trans_quad;
  83         int logical_apicid = generate_logical_apicid(quad, m->mpc_apicid);
  84
  85         printk(KERN_DEBUG "Processor #%d %u:%u APIC version %d (quad %d, apic %d)\n",
  86                m->mpc_apicid,
  87                (m->mpc_cpufeature & CPU_FAMILY_MASK) >> 8,
  88                (m->mpc_cpufeature & CPU_MODEL_MASK) >> 4,
  89                m->mpc_apicver, quad, logical_apicid);
  90         return logical_apicid;
  91 }
  92
  93 int mp_bus_id_to_node[MAX_MP_BUSSES];
  94
  95 int mp_bus_id_to_local[MAX_MP_BUSSES];
  96
  97 static void mpc_oem_bus_info(struct mpc_config_bus *m, char *name,
  98         struct mpc_config_translation *translation)
  99 {
 100         int quad = translation->trans_quad;
 101         int local = translation->trans_local;
 102
 103         mp_bus_id_to_node[m->mpc_busid] = quad;
 104         mp_bus_id_to_local[m->mpc_busid] = local;
 105         printk(KERN_INFO "Bus #%d is %s (node %d)\n",
 106                m->mpc_busid, name, quad);
 107 }
 108
 109 int quad_local_to_mp_bus_id [NR_CPUS/4][4];
 110 static void mpc_oem_pci_bus(struct mpc_config_bus *m,
 111         struct mpc_config_translation *translation)
 112 {
 113         int quad = translation->trans_quad;
 114         int local = translation->trans_local;
 115
 116         quad_local_to_mp_bus_id[quad][local] = m->mpc_busid;
 117 }
 118
 119 #endif
 120
 121 static void __cpuinit MP_processor_info(struct mpc_config_processor *m)
 122 {
 123         int apicid;
 124         char *bootup_cpu = "";
 125
 126         if (!(m->mpc_cpuflag & CPU_ENABLED)) {
 127                 disabled_cpus++;
 128                 return;
 129         }
 130 #ifdef CONFIG_X86_NUMAQ
 131         if (found_numaq)
 132                 apicid = mpc_apic_id(m, translation_table[mpc_record]);
 133         else
 134                 apicid = m->mpc_apicid;
 135 #else
 136         apicid = m->mpc_apicid;
 137 #endif
 138         if (m->mpc_cpuflag & CPU_BOOTPROCESSOR) {
 139                 bootup_cpu = " (Bootup-CPU)";
 140                 boot_cpu_physical_apicid = m->mpc_apicid;
 141         }
 142
 143         printk(KERN_INFO "Processor #%d%s\n", m->mpc_apicid, bootup_cpu);
 144         generic_processor_info(apicid, m->mpc_apicver);
 145 }
 146
 147 #ifdef CONFIG_X86_IO_APIC
 148 static void __init MP_bus_info(struct mpc_config_bus *m)
 149 {
 150         char str[7];
 151         memcpy(str, m->mpc_bustype, 6);
 152         str[6] = 0;
 153
 154 #ifdef CONFIG_X86_NUMAQ
 155         if (found_numaq)
 156                 mpc_oem_bus_info(m, str, translation_table[mpc_record]);
 157 #else
 158         printk(KERN_INFO "Bus #%d is %s\n", m->mpc_busid, str);
 159 #endif
 160
 161 #if MAX_MP_BUSSES < 256
 162         if (m->mpc_busid >= MAX_MP_BUSSES) {
 163                 printk(KERN_WARNING "MP table busid value (%d) for bustype %s "
 164                        " is too large, max. supported is %d\n",
 165                        m->mpc_busid, str, MAX_MP_BUSSES - 1);
 166                 return;
 167         }
 168 #endif
 169
 170         if (strncmp(str, BUSTYPE_ISA, sizeof(BUSTYPE_ISA) - 1) == 0) {
 171                  set_bit(m->mpc_busid, mp_bus_not_pci);
 172 #if defined(CONFIG_EISA) || defined (CONFIG_MCA)
 173                 mp_bus_id_to_type[m->mpc_busid] = MP_BUS_ISA;
 174 #endif
 175         } else if (strncmp(str, BUSTYPE_PCI, sizeof(BUSTYPE_PCI) - 1) == 0) {
 176 #ifdef CONFIG_X86_NUMAQ
 177                 if (found_numaq)
 178                         mpc_oem_pci_bus(m, translation_table[mpc_record]);
 179 #endif
 180                 clear_bit(m->mpc_busid, mp_bus_not_pci);
 181 #if defined(CONFIG_EISA) || defined (CONFIG_MCA)
 182                 mp_bus_id_to_type[m->mpc_busid] = MP_BUS_PCI;
 183         } else if (strncmp(str, BUSTYPE_EISA, sizeof(BUSTYPE_EISA) - 1) == 0) {
 184                 mp_bus_id_to_type[m->mpc_busid] = MP_BUS_EISA;
 185         } else if (strncmp(str, BUSTYPE_MCA, sizeof(BUSTYPE_MCA) - 1) == 0) {
 186                 mp_bus_id_to_type[m->mpc_busid] = MP_BUS_MCA;
 187 #endif
 188         } else
 189                 printk(KERN_WARNING "Unknown bustype %s - ignoring\n", str);
 190 }
 191 #endif
 192
 193 #ifdef CONFIG_X86_IO_APIC
 194
 195 static int bad_ioapic(unsigned long address)
 196 {
 197         if (nr_ioapics >= MAX_IO_APICS) {
 198                 printk(KERN_ERR "ERROR: Max # of I/O APICs (%d) exceeded "
 199                        "(found %d)\n", MAX_IO_APICS, nr_ioapics);
 200                 panic("Recompile kernel with bigger MAX_IO_APICS!\n");
 201         }
 202         if (!address) {
 203                 printk(KERN_ERR "WARNING: Bogus (zero) I/O APIC address"
 204                        " found in table, skipping!\n");
 205                 return 1;
 206         }
 207         return 0;
 208 }
 209
 210 static void __init MP_ioapic_info(struct mpc_config_ioapic *m)
 211 {
 212         if (!(m->mpc_flags & MPC_APIC_USABLE))
 213                 return;
 214
 215         printk(KERN_INFO "I/O APIC #%d Version %d at 0x%X.\n",
 216                m->mpc_apicid, m->mpc_apicver, m->mpc_apicaddr);
 217
 218         if (bad_ioapic(m->mpc_apicaddr))
 219                 return;
 220
 221         mp_ioapics[nr_ioapics].mp_apicaddr = m->mpc_apicaddr;
 222         mp_ioapics[nr_ioapics].mp_apicid = m->mpc_apicid;
 223         mp_ioapics[nr_ioapics].mp_type = m->mpc_type;
 224         mp_ioapics[nr_ioapics].mp_apicver = m->mpc_apicver;
 225         mp_ioapics[nr_ioapics].mp_flags = m->mpc_flags;
 226         nr_ioapics++;
 227 }
 228
 229 static void print_MP_intsrc_info(struct mpc_config_intsrc *m)
 230 {
 231         printk(KERN_CONT "Int: type %d, pol %d, trig %d, bus %02x,"
 232                 " IRQ %02x, APIC ID %x, APIC INT %02x\n",
 233                 m->mpc_irqtype, m->mpc_irqflag & 3,
 234                 (m->mpc_irqflag >> 2) & 3, m->mpc_srcbus,
 235                 m->mpc_srcbusirq, m->mpc_dstapic, m->mpc_dstirq);
 236 }
 237
 238 static void __init print_mp_irq_info(struct mp_config_intsrc *mp_irq)
 239 {
 240         printk(KERN_CONT "Int: type %d, pol %d, trig %d, bus %02x,"
 241                 " IRQ %02x, APIC ID %x, APIC INT %02x\n",
 242                 mp_irq->mp_irqtype, mp_irq->mp_irqflag & 3,
 243                 (mp_irq->mp_irqflag >> 2) & 3, mp_irq->mp_srcbus,
 244                 mp_irq->mp_srcbusirq, mp_irq->mp_dstapic, mp_irq->mp_dstirq);
 245 }
 246
 247 static void assign_to_mp_irq(struct mpc_config_intsrc *m,
 248                                     struct mp_config_intsrc *mp_irq)
 249 {
 250         mp_irq->mp_dstapic = m->mpc_dstapic;
 251         mp_irq->mp_type = m->mpc_type;
 252         mp_irq->mp_irqtype = m->mpc_irqtype;
 253         mp_irq->mp_irqflag = m->mpc_irqflag;
 254         mp_irq->mp_srcbus = m->mpc_srcbus;
 255         mp_irq->mp_srcbusirq = m->mpc_srcbusirq;
 256         mp_irq->mp_dstirq = m->mpc_dstirq;
 257 }
 258
 259 static void __init assign_to_mpc_intsrc(struct mp_config_intsrc *mp_irq,
 260                                         struct mpc_config_intsrc *m)
 261 {
 262         m->mpc_dstapic = mp_irq->mp_dstapic;
 263         m->mpc_type = mp_irq->mp_type;
 264         m->mpc_irqtype = mp_irq->mp_irqtype;
 265         m->mpc_irqflag = mp_irq->mp_irqflag;
 266         m->mpc_srcbus = mp_irq->mp_srcbus;
 267         m->mpc_srcbusirq = mp_irq->mp_srcbusirq;
 268         m->mpc_dstirq = mp_irq->mp_dstirq;
 269 }
 270
 271 static int mp_irq_mpc_intsrc_cmp(struct mp_config_intsrc *mp_irq,
 272                                         struct mpc_config_intsrc *m)
 273 {
 274         if (mp_irq->mp_dstapic != m->mpc_dstapic)
 275                 return 1;
 276         if (mp_irq->mp_type != m->mpc_type)
 277                 return 2;
 278         if (mp_irq->mp_irqtype != m->mpc_irqtype)
 279                 return 3;
 280         if (mp_irq->mp_irqflag != m->mpc_irqflag)
 281                 return 4;
 282         if (mp_irq->mp_srcbus != m->mpc_srcbus)
 283                 return 5;
 284         if (mp_irq->mp_srcbusirq != m->mpc_srcbusirq)
 285                 return 6;
 286         if (mp_irq->mp_dstirq != m->mpc_dstirq)
 287                 return 7;
 288
 289         return 0;
 290 }
 291
 292 void MP_intsrc_info(struct mpc_config_intsrc *m)
 293 {
 294         int i;
 295
 296         print_MP_intsrc_info(m);
 297
 298         for (i = 0; i < mp_irq_entries; i++) {
 299                 if (!mp_irq_mpc_intsrc_cmp(&mp_irqs[i], m))
 300                         return;
 301         }
 302
 303         assign_to_mp_irq(m, &mp_irqs[mp_irq_entries]);
 304         if (++mp_irq_entries == MAX_IRQ_SOURCES)
 305                 panic("Max # of irq sources exceeded!!\n");
 306 }
 307
 308 #endif
 309
 310 static void __init MP_lintsrc_info(struct mpc_config_lintsrc *m)
 311 {
 312         printk(KERN_INFO "Lint: type %d, pol %d, trig %d, bus %02x,"
 313                 " IRQ %02x, APIC ID %x, APIC LINT %02x\n",
 314                 m->mpc_irqtype, m->mpc_irqflag & 3,
 315                 (m->mpc_irqflag >> 2) & 3, m->mpc_srcbusid,
 316                 m->mpc_srcbusirq, m->mpc_destapic, m->mpc_destapiclint);
 317 }
 318
 319 #ifdef CONFIG_X86_NUMAQ
 320 static void __init MP_translation_info(struct mpc_config_translation *m)
 321 {
 322         printk(KERN_INFO
 323                "Translation: record %d, type %d, quad %d, global %d, local %d\n",
 324                mpc_record, m->trans_type, m->trans_quad, m->trans_global,
 325                m->trans_local);
 326
 327         if (mpc_record >= MAX_MPC_ENTRY)
 328                 printk(KERN_ERR "MAX_MPC_ENTRY exceeded!\n");
 329         else
 330                 translation_table[mpc_record] = m;      /* stash this for later */
 331         if (m->trans_quad < MAX_NUMNODES && !node_online(m->trans_quad))
 332                 node_set_online(m->trans_quad);
 333 }
 334
 335 /*
 336  * Read/parse the MPC oem tables
 337  */
 338
 339 static void __init smp_read_mpc_oem(struct mp_config_oemtable *oemtable,
 340                                     unsigned short oemsize)
 341 {
 342         int count = sizeof(*oemtable);  /* the header size */
 343         unsigned char *oemptr = ((unsigned char *)oemtable) + count;
 344
 345         mpc_record = 0;
 346         printk(KERN_INFO "Found an OEM MPC table at %8p - parsing it ... \n",
 347                oemtable);
 348         if (memcmp(oemtable->oem_signature, MPC_OEM_SIGNATURE, 4)) {
 349                 printk(KERN_WARNING
 350                        "SMP mpc oemtable: bad signature [%c%c%c%c]!\n",
 351                        oemtable->oem_signature[0], oemtable->oem_signature[1],
 352                        oemtable->oem_signature[2], oemtable->oem_signature[3]);
 353                 return;
 354         }
 355         if (mpf_checksum((unsigned char *)oemtable, oemtable->oem_length)) {
 356                 printk(KERN_WARNING "SMP oem mptable: checksum error!\n");
 357                 return;
 358         }
 359         while (count < oemtable->oem_length) {
 360                 switch (*oemptr) {
 361                 case MP_TRANSLATION:
 362                         {
 363                                 struct mpc_config_translation *m =
 364                                     (struct mpc_config_translation *)oemptr;
 365                                 MP_translation_info(m);
 366                                 oemptr += sizeof(*m);
 367                                 count += sizeof(*m);
 368                                 ++mpc_record;
 369                                 break;
 370                         }
 371                 default:
 372                         {
 373                                 printk(KERN_WARNING
 374                                        "Unrecognised OEM table entry type! - %d\n",
 375                                        (int)*oemptr);
 376                                 return;
 377                         }
 378                 }
 379         }
 380 }
 381
 382 void numaq_mps_oem_check(struct mp_config_table *mpc, char *oem,
 383                                  char *productid)
 384 {
 385         if (strncmp(oem, "IBM NUMA", 8))
 386                 printk("Warning!  Not a NUMA-Q system!\n");
 387         else
 388                 found_numaq = 1;
 389
 390         if (mpc->mpc_oemptr)
 391                 smp_read_mpc_oem((struct mp_config_oemtable *)mpc->mpc_oemptr,
 392                                  mpc->mpc_oemsize);
 393 }
 394 #endif /* CONFIG_X86_NUMAQ */
 395
 396 /*
 397  * Read/parse the MPC
 398  */
 399
 400 static int __init smp_check_mpc(struct mp_config_table *mpc, char *oem,
 401                                 char *str)
 402 {
 403
 404         if (memcmp(mpc->mpc_signature, MPC_SIGNATURE, 4)) {
 405                 printk(KERN_ERR "MPTABLE: bad signature [%c%c%c%c]!\n",
 406                        mpc->mpc_signature[0], mpc->mpc_signature[1],
 407                        mpc->mpc_signature[2], mpc->mpc_signature[3]);
 408                 return 0;
 409         }
 410         if (mpf_checksum((unsigned char *)mpc, mpc->mpc_length)) {
 411                 printk(KERN_ERR "MPTABLE: checksum error!\n");
 412                 return 0;
 413         }
 414         if (mpc->mpc_spec != 0x01 && mpc->mpc_spec != 0x04) {
 415                 printk(KERN_ERR "MPTABLE: bad table version (%d)!!\n",
 416                        mpc->mpc_spec);
 417                 return 0;
 418         }
 419         if (!mpc->mpc_lapic) {
 420                 printk(KERN_ERR "MPTABLE: null local APIC address!\n");
 421                 return 0;
 422         }
 423         memcpy(oem, mpc->mpc_oem, 8);
 424         oem[8] = 0;
 425         printk(KERN_INFO "MPTABLE: OEM ID: %s\n", oem);
 426
 427         memcpy(str, mpc->mpc_productid, 12);
 428         str[12] = 0;
 429
 430         printk(KERN_INFO "MPTABLE: Product ID: %s\n", str);
 431
 432         printk(KERN_INFO "MPTABLE: APIC at: 0x%X\n", mpc->mpc_lapic);
 433
 434         return 1;
 435 }
 436
 437 static int __init smp_read_mpc(struct mp_config_table *mpc, unsigned early)
 438 {
 439         char str[16];
 440         char oem[10];
 441
 442         int count = sizeof(*mpc);
 443         unsigned char *mpt = ((unsigned char *)mpc) + count;
 444
 445         if (!smp_check_mpc(mpc, oem, str))
 446                 return 0;
 447
 448 #ifdef CONFIG_X86_32
 449         /*
 450          * need to make sure summit and es7000's mps_oem_check is safe to be
 451          * called early via genericarch 's mps_oem_check
 452          */
 453         if (early) {
 454 #ifdef CONFIG_X86_NUMAQ
 455                 numaq_mps_oem_check(mpc, oem, str);
 456 #endif
 457         } else
 458                 mps_oem_check(mpc, oem, str);
 459 #endif
 460
 461         /* save the local APIC address, it might be non-default */
 462         if (!acpi_lapic)
 463                 mp_lapic_addr = mpc->mpc_lapic;
 464
 465         if (early)
 466                 return 1;
 467
 468         /*
 469          *      Now process the configuration blocks.
 470          */
 471 #ifdef CONFIG_X86_NUMAQ
 472         mpc_record = 0;
 473 #endif
 474         while (count < mpc->mpc_length) {
 475                 switch (*mpt) {
 476                 case MP_PROCESSOR:
 477                         {
 478                                 struct mpc_config_processor *m =
 479                                     (struct mpc_config_processor *)mpt;
 480                                 /* ACPI may have already provided this data */
 481                                 if (!acpi_lapic)
 482                                         MP_processor_info(m);
 483                                 mpt += sizeof(*m);
 484                                 count += sizeof(*m);
 485                                 break;
 486                         }
 487                 case MP_BUS:
 488                         {
 489                                 struct mpc_config_bus *m =
 490                                     (struct mpc_config_bus *)mpt;
 491 #ifdef CONFIG_X86_IO_APIC
 492                                 MP_bus_info(m);
 493 #endif
 494                                 mpt += sizeof(*m);
 495                                 count += sizeof(*m);
 496                                 break;
 497                         }
 498                 case MP_IOAPIC:
 499                         {
 500 #ifdef CONFIG_X86_IO_APIC
 501                                 struct mpc_config_ioapic *m =
 502                                     (struct mpc_config_ioapic *)mpt;
 503                                 MP_ioapic_info(m);
 504 #endif
 505                                 mpt += sizeof(struct mpc_config_ioapic);
 506                                 count += sizeof(struct mpc_config_ioapic);
 507                                 break;
 508                         }
 509                 case MP_INTSRC:
 510                         {
 511 #ifdef CONFIG_X86_IO_APIC
 512                                 struct mpc_config_intsrc *m =
 513                                     (struct mpc_config_intsrc *)mpt;
 514
 515                                 MP_intsrc_info(m);
 516 #endif
 517                                 mpt += sizeof(struct mpc_config_intsrc);
 518                                 count += sizeof(struct mpc_config_intsrc);
 519                                 break;
 520                         }
 521                 case MP_LINTSRC:
 522                         {
 523                                 struct mpc_config_lintsrc *m =
 524                                     (struct mpc_config_lintsrc *)mpt;
 525                                 MP_lintsrc_info(m);
 526                                 mpt += sizeof(*m);
 527                                 count += sizeof(*m);
 528                                 break;
 529                         }
 530                 default:
 531                         /* wrong mptable */
 532                         printk(KERN_ERR "Your mptable is wrong, contact your HW vendor!\n");
 533                         printk(KERN_ERR "type %x\n", *mpt);
 534                         print_hex_dump(KERN_ERR, "  ", DUMP_PREFIX_ADDRESS, 16,
 535                                         1, mpc, mpc->mpc_length, 1);
 536                         count = mpc->mpc_length;
 537                         break;
 538                 }
 539 #ifdef CONFIG_X86_NUMAQ
 540                 ++mpc_record;
 541 #endif
 542         }
 543
 544 #ifdef CONFIG_X86_GENERICARCH
 545        generic_bigsmp_probe();
 546 #endif
 547
 548         setup_apic_routing();
 549         if (!num_processors)
 550                 printk(KERN_ERR "MPTABLE: no processors registered!\n");
 551         return num_processors;
 552 }
 553
 554 #ifdef CONFIG_X86_IO_APIC
 555
 556 static int __init ELCR_trigger(unsigned int irq)
 557 {
 558         unsigned int port;
 559
 560         port = 0x4d0 + (irq >> 3);
 561         return (inb(port) >> (irq & 7)) & 1;
 562 }
 563
 564 static void __init construct_default_ioirq_mptable(int mpc_default_type)
 565 {
 566         struct mpc_config_intsrc intsrc;
 567         int i;
 568         int ELCR_fallback = 0;
 569
 570         intsrc.mpc_type = MP_INTSRC;
 571         intsrc.mpc_irqflag = 0; /* conforming */
 572         intsrc.mpc_srcbus = 0;
 573         intsrc.mpc_dstapic = mp_ioapics[0].mp_apicid;
 574
 575         intsrc.mpc_irqtype = mp_INT;
 576
 577         /*
 578          *  If true, we have an ISA/PCI system with no IRQ entries
 579          *  in the MP table. To prevent the PCI interrupts from being set up
 580          *  incorrectly, we try to use the ELCR. The sanity check to see if
 581          *  there is good ELCR data is very simple - IRQ0, 1, 2 and 13 can
 582          *  never be level sensitive, so we simply see if the ELCR agrees.
 583          *  If it does, we assume it's valid.
 584          */
 585         if (mpc_default_type == 5) {
 586                 printk(KERN_INFO "ISA/PCI bus type with no IRQ information... "
 587                        "falling back to ELCR\n");
 588
 589                 if (ELCR_trigger(0) || ELCR_trigger(1) || ELCR_trigger(2) ||
 590                     ELCR_trigger(13))
 591                         printk(KERN_ERR "ELCR contains invalid data... "
 592                                "not using ELCR\n");
 593                 else {
 594                         printk(KERN_INFO
 595                                "Using ELCR to identify PCI interrupts\n");
 596                         ELCR_fallback = 1;
 597                 }
 598         }
 599
 600         for (i = 0; i < 16; i++) {
 601                 switch (mpc_default_type) {
 602                 case 2:
 603                         if (i == 0 || i == 13)
 604                                 continue;       /* IRQ0 & IRQ13 not connected */
 605                         /* fall through */
 606                 default:
 607                         if (i == 2)
 608                                 continue;       /* IRQ2 is never connected */
 609                 }
 610
 611                 if (ELCR_fallback) {
 612                         /*
 613                          *  If the ELCR indicates a level-sensitive interrupt, we
 614                          *  copy that information over to the MP table in the
 615                          *  irqflag field (level sensitive, active high polarity).
 616                          */
 617                         if (ELCR_trigger(i))
 618                                 intsrc.mpc_irqflag = 13;
 619                         else
 620                                 intsrc.mpc_irqflag = 0;
 621                 }
 622
 623                 intsrc.mpc_srcbusirq = i;
 624                 intsrc.mpc_dstirq = i ? i : 2;  /* IRQ0 to INTIN2 */
 625                 MP_intsrc_info(&intsrc);
 626         }
 627
 628         intsrc.mpc_irqtype = mp_ExtINT;
 629         intsrc.mpc_srcbusirq = 0;
 630         intsrc.mpc_dstirq = 0;  /* 8259A to INTIN0 */
 631         MP_intsrc_info(&intsrc);
 632 }
 633
 634
 635 static void construct_ioapic_table(int mpc_default_type)
 636 {
 637         struct mpc_config_ioapic ioapic;
 638         struct mpc_config_bus bus;
 639
 640         bus.mpc_type = MP_BUS;
 641         bus.mpc_busid = 0;
 642         switch (mpc_default_type) {
 643         default:
 644                 printk(KERN_ERR "???\nUnknown standard configuration %d\n",
 645                        mpc_default_type);
 646                 /* fall through */
 647         case 1:
 648         case 5:
 649                 memcpy(bus.mpc_bustype, "ISA   ", 6);
 650                 break;
 651         case 2:
 652         case 6:
 653         case 3:
 654                 memcpy(bus.mpc_bustype, "EISA  ", 6);
 655                 break;
 656         case 4:
 657         case 7:
 658                 memcpy(bus.mpc_bustype, "MCA   ", 6);
 659         }
 660         MP_bus_info(&bus);
 661         if (mpc_default_type > 4) {
 662                 bus.mpc_busid = 1;
 663                 memcpy(bus.mpc_bustype, "PCI   ", 6);
 664                 MP_bus_info(&bus);
 665         }
 666
 667         ioapic.mpc_type = MP_IOAPIC;
 668         ioapic.mpc_apicid = 2;
 669         ioapic.mpc_apicver = mpc_default_type > 4 ? 0x10 : 0x01;
 670         ioapic.mpc_flags = MPC_APIC_USABLE;
 671         ioapic.mpc_apicaddr = 0xFEC00000;
 672         MP_ioapic_info(&ioapic);
 673
 674         /*
 675          * We set up most of the low 16 IO-APIC pins according to MPS rules.
 676          */
 677         construct_default_ioirq_mptable(mpc_default_type);
 678 }
 679 #else
 680 static inline void construct_ioapic_table(int mpc_default_type) { }
 681 #endif
 682
 683 static inline void __init construct_default_ISA_mptable(int mpc_default_type)
 684 {
 685         struct mpc_config_processor processor;
 686         struct mpc_config_lintsrc lintsrc;
 687         int linttypes[2] = { mp_ExtINT, mp_NMI };
 688         int i;
 689
 690         /*
 691          * local APIC has default address
 692          */
 693         mp_lapic_addr = APIC_DEFAULT_PHYS_BASE;
 694
 695         /*
 696          * 2 CPUs, numbered 0 & 1.
 697          */
 698         processor.mpc_type = MP_PROCESSOR;
 699         /* Either an integrated APIC or a discrete 82489DX. */
 700         processor.mpc_apicver = mpc_default_type > 4 ? 0x10 : 0x01;
 701         processor.mpc_cpuflag = CPU_ENABLED;
 702         processor.mpc_cpufeature = (boot_cpu_data.x86 << 8) |
 703             (boot_cpu_data.x86_model << 4) | boot_cpu_data.x86_mask;
 704         processor.mpc_featureflag = boot_cpu_data.x86_capability[0];
 705         processor.mpc_reserved[0] = 0;
 706         processor.mpc_reserved[1] = 0;
 707         for (i = 0; i < 2; i++) {
 708                 processor.mpc_apicid = i;
 709                 MP_processor_info(&processor);
 710         }
 711
 712         construct_ioapic_table(mpc_default_type);
 713
 714         lintsrc.mpc_type = MP_LINTSRC;
 715         lintsrc.mpc_irqflag = 0;        /* conforming */
 716         lintsrc.mpc_srcbusid = 0;
 717         lintsrc.mpc_srcbusirq = 0;
 718         lintsrc.mpc_destapic = MP_APIC_ALL;
 719         for (i = 0; i < 2; i++) {
 720                 lintsrc.mpc_irqtype = linttypes[i];
 721                 lintsrc.mpc_destapiclint = i;
 722                 MP_lintsrc_info(&lintsrc);
 723         }
 724 }
 725
 726 static struct intel_mp_floating *mpf_found;
 727
 728 /*
 729  * Scan the memory blocks for an SMP configuration block.
 730  */
 731 static void __init __get_smp_config(unsigned early)
 732 {
 733         struct intel_mp_floating *mpf = mpf_found;
 734
 735         if (acpi_lapic && early)
 736                 return;
 737         /*
 738          * ACPI supports both logical (e.g. Hyper-Threading) and physical
 739          * processors, where MPS only supports physical.
 740          */
 741         if (acpi_lapic && acpi_ioapic) {
 742                 printk(KERN_INFO "Using ACPI (MADT) for SMP configuration "
 743                        "information\n");
 744                 return;
 745         } else if (acpi_lapic)
 746                 printk(KERN_INFO "Using ACPI for processor (LAPIC) "
 747                        "configuration information\n");
 748
 749         printk(KERN_INFO "Intel MultiProcessor Specification v1.%d\n",
 750                mpf->mpf_specification);
 751 #if defined(CONFIG_X86_LOCAL_APIC) && defined(CONFIG_X86_32)
 752         if (mpf->mpf_feature2 & (1 << 7)) {
 753                 printk(KERN_INFO "    IMCR and PIC compatibility mode.\n");
 754                 pic_mode = 1;
 755         } else {
 756                 printk(KERN_INFO "    Virtual Wire compatibility mode.\n");
 757                 pic_mode = 0;
 758         }
 759 #endif
 760         /*
 761          * Now see if we need to read further.
 762          */
 763         if (mpf->mpf_feature1 != 0) {
 764                 if (early) {
 765                         /*
 766                          * local APIC has default address
 767                          */
 768                         mp_lapic_addr = APIC_DEFAULT_PHYS_BASE;
 769                         return;
 770                 }
 771
 772                 printk(KERN_INFO "Default MP configuration #%d\n",
 773                        mpf->mpf_feature1);
 774                 construct_default_ISA_mptable(mpf->mpf_feature1);
 775
 776         } else if (mpf->mpf_physptr) {
 777
 778                 /*
 779                  * Read the physical hardware table.  Anything here will
 780                  * override the defaults.
 781                  */
 782                 if (!smp_read_mpc(phys_to_virt(mpf->mpf_physptr), early)) {
 783 #ifdef CONFIG_X86_LOCAL_APIC
 784                         smp_found_config = 0;
 785 #endif
 786                         printk(KERN_ERR
 787                                "BIOS bug, MP table errors detected!...\n");
 788                         printk(KERN_ERR "... disabling SMP support. "
 789                                "(tell your hw vendor)\n");
 790                         return;
 791                 }
 792
 793                 if (early)
 794                         return;
 795 #ifdef CONFIG_X86_IO_APIC
 796                 /*
 797                  * If there are no explicit MP IRQ entries, then we are
 798                  * broken.  We set up most of the low 16 IO-APIC pins to
 799                  * ISA defaults and hope it will work.
 800                  */
 801                 if (!mp_irq_entries) {
 802                         struct mpc_config_bus bus;
 803
 804                         printk(KERN_ERR "BIOS bug, no explicit IRQ entries, "
 805                                "using default mptable. "
 806                                "(tell your hw vendor)\n");
 807
 808                         bus.mpc_type = MP_BUS;
 809                         bus.mpc_busid = 0;
 810                         memcpy(bus.mpc_bustype, "ISA   ", 6);
 811                         MP_bus_info(&bus);
 812
 813                         construct_default_ioirq_mptable(0);
 814                 }
 815 #endif
 816         } else
 817                 BUG();
 818
 819         if (!early)
 820                 printk(KERN_INFO "Processors: %d\n", num_processors);
 821         /*
 822          * Only use the first configuration found.
 823          */
 824 }
 825
 826 void __init early_get_smp_config(void)
 827 {
 828         __get_smp_config(1);
 829 }
 830
 831 void __init get_smp_config(void)
 832 {
 833         __get_smp_config(0);
 834 }
 835
 836 static int __init smp_scan_config(unsigned long base, unsigned long length,
 837                                   unsigned reserve)
 838 {
 839         unsigned int *bp = phys_to_virt(base);
 840         struct intel_mp_floating *mpf;
 841
 842         printk(KERN_DEBUG "Scan SMP from %p for %ld bytes.\n", bp, length);
 843         BUILD_BUG_ON(sizeof(*mpf) != 16);
 844
 845         while (length > 0) {
 846                 mpf = (struct intel_mp_floating *)bp;
 847                 if ((*bp == SMP_MAGIC_IDENT) &&
 848                     (mpf->mpf_length == 1) &&
 849                     !mpf_checksum((unsigned char *)bp, 16) &&
 850                     ((mpf->mpf_specification == 1)
 851                      || (mpf->mpf_specification == 4))) {
 852 #ifdef CONFIG_X86_LOCAL_APIC
 853                         smp_found_config = 1;
 854 #endif
 855                         mpf_found = mpf;
 856
 857                         printk(KERN_INFO "found SMP MP-table at [%p] %08lx\n",
 858                                mpf, virt_to_phys(mpf));
 859
 860                         if (!reserve)
 861                                 return 1;
 862                         reserve_bootmem_generic(virt_to_phys(mpf), PAGE_SIZE,
 863                                         BOOTMEM_DEFAULT);
 864                         if (mpf->mpf_physptr) {
 865                                 unsigned long size = PAGE_SIZE;
 866 #ifdef CONFIG_X86_32
 867                                 /*
 868                                  * We cannot access to MPC table to compute
 869                                  * table size yet, as only few megabytes from
 870                                  * the bottom is mapped now.
 871                                  * PC-9800's MPC table places on the very last
 872                                  * of physical memory; so that simply reserving
 873                                  * PAGE_SIZE from mpg->mpf_physptr yields BUG()
 874                                  * in reserve_bootmem.
 875                                  */
 876                                 unsigned long end = max_low_pfn * PAGE_SIZE;
 877                                 if (mpf->mpf_physptr + size > end)
 878                                         size = end - mpf->mpf_physptr;
 879 #endif
 880                                 reserve_bootmem_generic(mpf->mpf_physptr, size,
 881                                                 BOOTMEM_DEFAULT);
 882                         }
 883
 884                         return 1;
 885                 }
 886                 bp += 4;
 887                 length -= 16;
 888         }
 889         return 0;
 890 }
 891
 892 static void __init __find_smp_config(unsigned reserve)
 893 {
 894         unsigned int address;
 895
 896         /*
 897          * FIXME: Linux assumes you have 640K of base ram..
 898          * this continues the error...
 899          *
 900          * 1) Scan the bottom 1K for a signature
 901          * 2) Scan the top 1K of base RAM
 902          * 3) Scan the 64K of bios
 903          */
 904         if (smp_scan_config(0x0, 0x400, reserve) ||
 905             smp_scan_config(639 * 0x400, 0x400, reserve) ||
 906             smp_scan_config(0xF0000, 0x10000, reserve))
 907                 return;
 908         /*
 909          * If it is an SMP machine we should know now, unless the
 910          * configuration is in an EISA/MCA bus machine with an
 911          * extended bios data area.
 912          *
 913          * there is a real-mode segmented pointer pointing to the
 914          * 4K EBDA area at 0x40E, calculate and scan it here.
 915          *
 916          * NOTE! There are Linux loaders that will corrupt the EBDA
 917          * area, and as such this kind of SMP config may be less
 918          * trustworthy, simply because the SMP table may have been
 919          * stomped on during early boot. These loaders are buggy and
 920          * should be fixed.
 921          *
 922          * MP1.4 SPEC states to only scan first 1K of 4K EBDA.
 923          */
 924
 925         address = get_bios_ebda();
 926         if (address)
 927                 smp_scan_config(address, 0x400, reserve);
 928 }
 929
 930 void __init early_find_smp_config(void)
 931 {
 932         __find_smp_config(0);
 933 }
 934
 935 void __init find_smp_config(void)
 936 {
 937         __find_smp_config(1);
 938 }
 939
 940 #ifdef CONFIG_X86_IO_APIC
 941 static u8 __initdata irq_used[MAX_IRQ_SOURCES];
 942
 943 static int  __init get_MP_intsrc_index(struct mpc_config_intsrc *m)
 944 {
 945         int i;
 946
 947         if (m->mpc_irqtype != mp_INT)
 948                 return 0;
 949
 950         if (m->mpc_irqflag != 0x0f)
 951                 return 0;
 952
 953         /* not legacy */
 954
 955         for (i = 0; i < mp_irq_entries; i++) {
 956                 if (mp_irqs[i].mp_irqtype != mp_INT)
 957                         continue;
 958
 959                 if (mp_irqs[i].mp_irqflag != 0x0f)
 960                         continue;
 961
 962                 if (mp_irqs[i].mp_srcbus != m->mpc_srcbus)
 963                         continue;
 964                 if (mp_irqs[i].mp_srcbusirq != m->mpc_srcbusirq)
 965                         continue;
 966                 if (irq_used[i]) {
 967                         /* already claimed */
 968                         return -2;
 969                 }
 970                 irq_used[i] = 1;
 971                 return i;
 972         }
 973
 974         /* not found */
 975         return -1;
 976 }
 977
 978 #define SPARE_SLOT_NUM 20
 979
 980 static struct mpc_config_intsrc __initdata *m_spare[SPARE_SLOT_NUM];
 981 #endif
 982
 983 static int  __init replace_intsrc_all(struct mp_config_table *mpc,
 984                                         unsigned long mpc_new_phys,
 985                                         unsigned long mpc_new_length)
 986 {
 987 #ifdef CONFIG_X86_IO_APIC
 988         int i;
 989         int nr_m_spare = 0;
 990 #endif
 991
 992         int count = sizeof(*mpc);
 993         unsigned char *mpt = ((unsigned char *)mpc) + count;
 994
 995         printk(KERN_INFO "mpc_length %x\n", mpc->mpc_length);
 996         while (count < mpc->mpc_length) {
 997                 switch (*mpt) {
 998                 case MP_PROCESSOR:
 999                         {
1000                                 struct mpc_config_processor *m =
1001                                     (struct mpc_config_processor *)mpt;
1002                                 mpt += sizeof(*m);
1003                                 count += sizeof(*m);
1004                                 break;
1005                         }
1006                 case MP_BUS:
1007                         {
1008                                 struct mpc_config_bus *m =
1009                                     (struct mpc_config_bus *)mpt;
1010                                 mpt += sizeof(*m);
1011                                 count += sizeof(*m);
1012                                 break;
1013                         }
1014                 case MP_IOAPIC:
1015                         {
1016                                 mpt += sizeof(struct mpc_config_ioapic);
1017                                 count += sizeof(struct mpc_config_ioapic);
1018                                 break;
1019                         }
1020                 case MP_INTSRC:
1021                         {
1022 #ifdef CONFIG_X86_IO_APIC
1023                                 struct mpc_config_intsrc *m =
1024                                     (struct mpc_config_intsrc *)mpt;
1025
1026                                 printk(KERN_INFO "OLD ");
1027                                 print_MP_intsrc_info(m);
1028                                 i = get_MP_intsrc_index(m);
1029                                 if (i > 0) {
1030                                         assign_to_mpc_intsrc(&mp_irqs[i], m);
1031                                         printk(KERN_INFO "NEW ");
1032                                         print_mp_irq_info(&mp_irqs[i]);
1033                                 } else if (!i) {
1034                                         /* legacy, do nothing */
1035                                 } else if (nr_m_spare < SPARE_SLOT_NUM) {
1036                                         /*
1037                                          * not found (-1), or duplicated (-2)
1038                                          * are invalid entries,
1039                                          * we need to use the slot  later
1040                                          */
1041                                         m_spare[nr_m_spare] = m;
1042                                         nr_m_spare++;
1043                                 }
1044 #endif
1045                                 mpt += sizeof(struct mpc_config_intsrc);
1046                                 count += sizeof(struct mpc_config_intsrc);
1047                                 break;
1048                         }
1049                 case MP_LINTSRC:
1050                         {
1051                                 struct mpc_config_lintsrc *m =
1052                                     (struct mpc_config_lintsrc *)mpt;
1053                                 mpt += sizeof(*m);
1054                                 count += sizeof(*m);
1055                                 break;
1056                         }
1057                 default:
1058                         /* wrong mptable */
1059                         printk(KERN_ERR "Your mptable is wrong, contact your HW vendor!\n");
1060                         printk(KERN_ERR "type %x\n", *mpt);
1061                         print_hex_dump(KERN_ERR, "  ", DUMP_PREFIX_ADDRESS, 16,
1062                                         1, mpc, mpc->mpc_length, 1);
1063                         goto out;
1064                 }
1065         }
1066
1067 #ifdef CONFIG_X86_IO_APIC
1068         for (i = 0; i < mp_irq_entries; i++) {
1069                 if (irq_used[i])
1070                         continue;
1071
1072                 if (mp_irqs[i].mp_irqtype != mp_INT)
1073                         continue;
1074
1075                 if (mp_irqs[i].mp_irqflag != 0x0f)
1076                         continue;
1077
1078                 if (nr_m_spare > 0) {
1079                         printk(KERN_INFO "*NEW* found ");
1080                         nr_m_spare--;
1081                         assign_to_mpc_intsrc(&mp_irqs[i], m_spare[nr_m_spare]);
1082                         m_spare[nr_m_spare] = NULL;
1083                 } else {
1084                         struct mpc_config_intsrc *m =
1085                             (struct mpc_config_intsrc *)mpt;
1086                         count += sizeof(struct mpc_config_intsrc);
1087                         if (!mpc_new_phys) {
1088                                 printk(KERN_INFO "No spare slots, try to append...take your risk, new mpc_length %x\n", count);
1089                         } else {
1090                                 if (count <= mpc_new_length)
1091                                         printk(KERN_INFO "No spare slots, try to append..., new mpc_length %x\n", count);
1092                                 else {
1093                                         printk(KERN_ERR "mpc_new_length %lx is too small\n", mpc_new_length);
1094                                         goto out;
1095                                 }
1096                         }
1097                         assign_to_mpc_intsrc(&mp_irqs[i], m);
1098                         mpc->mpc_length = count;
1099                         mpt += sizeof(struct mpc_config_intsrc);
1100                 }
1101                 print_mp_irq_info(&mp_irqs[i]);
1102         }
1103 #endif
1104 out:
1105         /* update checksum */
1106         mpc->mpc_checksum = 0;
1107         mpc->mpc_checksum -= mpf_checksum((unsigned char *)mpc,
1108                                            mpc->mpc_length);
1109
1110         return 0;
1111 }
1112
1113 int __initdata enable_update_mptable;
1114
1115 static int __init update_mptable_setup(char *str)
1116 {
1117         enable_update_mptable = 1;
1118         return 0;
1119 }
1120 early_param("update_mptable", update_mptable_setup);
1121
1122 static unsigned long __initdata mpc_new_phys;
1123 static unsigned long mpc_new_length __initdata = 4096;
1124
1125 /* alloc_mptable or alloc_mptable=4k */
1126 static int __initdata alloc_mptable;
1127 static int __init parse_alloc_mptable_opt(char *p)
1128 {
1129         enable_update_mptable = 1;
1130         alloc_mptable = 1;
1131         if (!p)
1132                 return 0;
1133         mpc_new_length = memparse(p, &p);
1134         return 0;
1135 }
1136 early_param("alloc_mptable", parse_alloc_mptable_opt);
1137
1138 void __init early_reserve_e820_mpc_new(void)
1139 {
1140         if (enable_update_mptable && alloc_mptable) {
1141                 u64 startt = 0;
1142 #ifdef CONFIG_X86_TRAMPOLINE
1143                 startt = TRAMPOLINE_BASE;
1144 #endif
1145                 mpc_new_phys = early_reserve_e820(startt, mpc_new_length, 4);
1146         }
1147 }
1148
1149 static int __init update_mp_table(void)
1150 {
1151         char str[16];
1152         char oem[10];
1153         struct intel_mp_floating *mpf;
1154         struct mp_config_table *mpc;
1155         struct mp_config_table *mpc_new;
1156
1157         if (!enable_update_mptable)
1158                 return 0;
1159
1160         mpf = mpf_found;
1161         if (!mpf)
1162                 return 0;
1163
1164         /*
1165          * Now see if we need to go further.
1166          */
1167         if (mpf->mpf_feature1 != 0)
1168                 return 0;
1169
1170         if (!mpf->mpf_physptr)
1171                 return 0;
1172
1173         mpc = phys_to_virt(mpf->mpf_physptr);
1174
1175         if (!smp_check_mpc(mpc, oem, str))
1176                 return 0;
1177
1178         printk(KERN_INFO "mpf: %lx\n", virt_to_phys(mpf));
1179         printk(KERN_INFO "mpf_physptr: %x\n", mpf->mpf_physptr);
1180
1181         if (mpc_new_phys && mpc->mpc_length > mpc_new_length) {
1182                 mpc_new_phys = 0;
1183                 printk(KERN_INFO "mpc_new_length is %ld, please use alloc_mptable=8k\n",
1184                          mpc_new_length);
1185         }
1186
1187         if (!mpc_new_phys) {
1188                 unsigned char old, new;
1189                 /* check if we can change the postion */
1190                 mpc->mpc_checksum = 0;
1191                 old = mpf_checksum((unsigned char *)mpc, mpc->mpc_length);
1192                 mpc->mpc_checksum = 0xff;
1193                 new = mpf_checksum((unsigned char *)mpc, mpc->mpc_length);
1194                 if (old == new) {
1195                         printk(KERN_INFO "mpc is readonly, please try alloc_mptable instead\n");
1196                         return 0;
1197                 }
1198                 printk(KERN_INFO "use in-positon replacing\n");
1199         } else {
1200                 mpf->mpf_physptr = mpc_new_phys;
1201                 mpc_new = phys_to_virt(mpc_new_phys);
1202                 memcpy(mpc_new, mpc, mpc->mpc_length);
1203                 mpc = mpc_new;
1204                 /* check if we can modify that */
1205                 if (mpc_new_phys - mpf->mpf_physptr) {
1206                         struct intel_mp_floating *mpf_new;
1207                         /* steal 16 bytes from [0, 1k) */
1208                         printk(KERN_INFO "mpf new: %x\n", 0x400 - 16);
1209                         mpf_new = phys_to_virt(0x400 - 16);
1210                         memcpy(mpf_new, mpf, 16);
1211                         mpf = mpf_new;
1212                         mpf->mpf_physptr = mpc_new_phys;
1213                 }
1214                 mpf->mpf_checksum = 0;
1215                 mpf->mpf_checksum -= mpf_checksum((unsigned char *)mpf, 16);
1216                 printk(KERN_INFO "mpf_physptr new: %x\n", mpf->mpf_physptr);
1217         }
1218
1219         /*
1220          * only replace the one with mp_INT and
1221          *       MP_IRQ_TRIGGER_LEVEL|MP_IRQ_POLARITY_LOW,
1222          * already in mp_irqs , stored by ... and mp_config_acpi_gsi,
1223          * may need pci=routeirq for all coverage
1224          */
1225         replace_intsrc_all(mpc, mpc_new_phys, mpc_new_length);
1226
1227         return 0;
1228 }
1229
1230 late_initcall(update_mp_table);