mpparse_64.c 20 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845
  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. *
  8. * Fixes
  9. * Erich Boleyn : MP v1.4 and additional changes.
  10. * Alan Cox : Added EBDA scanning
  11. * Ingo Molnar : various cleanups and rewrites
  12. * Maciej W. Rozycki: Bits for default MP configurations
  13. * Paul Diefenbaugh: Added full ACPI support
  14. */
  15. #include <linux/mm.h>
  16. #include <linux/init.h>
  17. #include <linux/delay.h>
  18. #include <linux/bootmem.h>
  19. #include <linux/kernel_stat.h>
  20. #include <linux/mc146818rtc.h>
  21. #include <linux/acpi.h>
  22. #include <linux/module.h>
  23. #include <asm/smp.h>
  24. #include <asm/mtrr.h>
  25. #include <asm/mpspec.h>
  26. #include <asm/pgalloc.h>
  27. #include <asm/io_apic.h>
  28. #include <asm/proto.h>
  29. #include <asm/acpi.h>
  30. #include <asm/bios_ebda.h>
  31. #include <mach_apic.h>
  32. /* Have we found an MP table */
  33. int smp_found_config;
  34. /*
  35. * Various Linux-internal data structures created from the
  36. * MP-table.
  37. */
  38. DECLARE_BITMAP(mp_bus_not_pci, MAX_MP_BUSSES);
  39. int mp_bus_id_to_pci_bus[MAX_MP_BUSSES] = {[0 ... MAX_MP_BUSSES - 1] = -1 };
  40. static int mp_current_pci_id = 0;
  41. /* Make it easy to share the UP and SMP code: */
  42. #ifndef CONFIG_X86_SMP
  43. unsigned int num_processors;
  44. unsigned disabled_cpus __cpuinitdata;
  45. #ifndef CONFIG_X86_LOCAL_APIC
  46. unsigned int boot_cpu_physical_apicid = -1U;
  47. #endif
  48. #endif
  49. /*
  50. * Intel MP BIOS table parsing routines:
  51. */
  52. /*
  53. * Checksum an MP configuration block.
  54. */
  55. static int __init mpf_checksum(unsigned char *mp, int len)
  56. {
  57. int sum = 0;
  58. while (len--)
  59. sum += *mp++;
  60. return sum & 0xFF;
  61. }
  62. static void __cpuinit MP_processor_info(struct mpc_config_processor *m)
  63. {
  64. char *bootup_cpu = "";
  65. if (!(m->mpc_cpuflag & CPU_ENABLED)) {
  66. disabled_cpus++;
  67. return;
  68. }
  69. if (m->mpc_cpuflag & CPU_BOOTPROCESSOR) {
  70. bootup_cpu = " (Bootup-CPU)";
  71. boot_cpu_physical_apicid = m->mpc_apicid;
  72. }
  73. printk(KERN_INFO "Processor #%d%s\n", m->mpc_apicid, bootup_cpu);
  74. generic_processor_info(m->mpc_apicid, 0);
  75. }
  76. static void __init MP_bus_info(struct mpc_config_bus *m)
  77. {
  78. char str[7];
  79. memcpy(str, m->mpc_bustype, 6);
  80. str[6] = 0;
  81. Dprintk("Bus #%d is %s\n", m->mpc_busid, str);
  82. if (strncmp(str, "ISA", 3) == 0) {
  83. set_bit(m->mpc_busid, mp_bus_not_pci);
  84. } else if (strncmp(str, "PCI", 3) == 0) {
  85. clear_bit(m->mpc_busid, mp_bus_not_pci);
  86. mp_bus_id_to_pci_bus[m->mpc_busid] = mp_current_pci_id;
  87. mp_current_pci_id++;
  88. } else {
  89. printk(KERN_ERR "Unknown bustype %s\n", str);
  90. }
  91. }
  92. static int bad_ioapic(unsigned long address)
  93. {
  94. if (nr_ioapics >= MAX_IO_APICS) {
  95. printk(KERN_ERR "ERROR: Max # of I/O APICs (%d) exceeded "
  96. "(found %d)\n", MAX_IO_APICS, nr_ioapics);
  97. panic("Recompile kernel with bigger MAX_IO_APICS!\n");
  98. }
  99. if (!address) {
  100. printk(KERN_ERR "WARNING: Bogus (zero) I/O APIC address"
  101. " found in table, skipping!\n");
  102. return 1;
  103. }
  104. return 0;
  105. }
  106. static void __init MP_ioapic_info(struct mpc_config_ioapic *m)
  107. {
  108. if (!(m->mpc_flags & MPC_APIC_USABLE))
  109. return;
  110. printk(KERN_INFO "I/O APIC #%d at 0x%X.\n", m->mpc_apicid,
  111. m->mpc_apicaddr);
  112. if (bad_ioapic(m->mpc_apicaddr))
  113. return;
  114. mp_ioapics[nr_ioapics] = *m;
  115. nr_ioapics++;
  116. }
  117. static void __init MP_intsrc_info(struct mpc_config_intsrc *m)
  118. {
  119. mp_irqs[mp_irq_entries] = *m;
  120. Dprintk("Int: type %d, pol %d, trig %d, bus %d,"
  121. " IRQ %02x, APIC ID %x, APIC INT %02x\n",
  122. m->mpc_irqtype, m->mpc_irqflag & 3,
  123. (m->mpc_irqflag >> 2) & 3, m->mpc_srcbus,
  124. m->mpc_srcbusirq, m->mpc_dstapic, m->mpc_dstirq);
  125. if (++mp_irq_entries >= MAX_IRQ_SOURCES)
  126. panic("Max # of irq sources exceeded!!\n");
  127. }
  128. static void __init MP_lintsrc_info(struct mpc_config_lintsrc *m)
  129. {
  130. Dprintk("Lint: type %d, pol %d, trig %d, bus %d,"
  131. " IRQ %02x, APIC ID %x, APIC LINT %02x\n",
  132. m->mpc_irqtype, m->mpc_irqflag & 3,
  133. (m->mpc_irqflag >> 2) & 3, m->mpc_srcbusid,
  134. m->mpc_srcbusirq, m->mpc_destapic, m->mpc_destapiclint);
  135. }
  136. /*
  137. * Read/parse the MPC
  138. */
  139. static int __init smp_read_mpc(struct mp_config_table *mpc, unsigned early)
  140. {
  141. char str[16];
  142. int count = sizeof(*mpc);
  143. unsigned char *mpt = ((unsigned char *)mpc) + count;
  144. if (memcmp(mpc->mpc_signature, MPC_SIGNATURE, 4)) {
  145. printk(KERN_ERR "MPTABLE: bad signature [%c%c%c%c]!\n",
  146. mpc->mpc_signature[0],
  147. mpc->mpc_signature[1],
  148. mpc->mpc_signature[2], mpc->mpc_signature[3]);
  149. return 0;
  150. }
  151. if (mpf_checksum((unsigned char *)mpc, mpc->mpc_length)) {
  152. printk(KERN_ERR "MPTABLE: checksum error!\n");
  153. return 0;
  154. }
  155. if (mpc->mpc_spec != 0x01 && mpc->mpc_spec != 0x04) {
  156. printk(KERN_ERR "MPTABLE: bad table version (%d)!!\n",
  157. mpc->mpc_spec);
  158. return 0;
  159. }
  160. if (!mpc->mpc_lapic) {
  161. printk(KERN_ERR "MPTABLE: null local APIC address!\n");
  162. return 0;
  163. }
  164. memcpy(str, mpc->mpc_oem, 8);
  165. str[8] = 0;
  166. printk(KERN_INFO "MPTABLE: OEM ID: %s ", str);
  167. memcpy(str, mpc->mpc_productid, 12);
  168. str[12] = 0;
  169. printk(KERN_INFO "MPTABLE: Product ID: %s ", str);
  170. printk(KERN_INFO "MPTABLE: APIC at: 0x%X\n", mpc->mpc_lapic);
  171. /* save the local APIC address, it might be non-default */
  172. if (!acpi_lapic)
  173. mp_lapic_addr = mpc->mpc_lapic;
  174. if (early)
  175. return 1;
  176. /*
  177. * Now process the configuration blocks.
  178. */
  179. while (count < mpc->mpc_length) {
  180. switch (*mpt) {
  181. case MP_PROCESSOR:
  182. {
  183. struct mpc_config_processor *m =
  184. (struct mpc_config_processor *)mpt;
  185. if (!acpi_lapic)
  186. MP_processor_info(m);
  187. mpt += sizeof(*m);
  188. count += sizeof(*m);
  189. break;
  190. }
  191. case MP_BUS:
  192. {
  193. struct mpc_config_bus *m =
  194. (struct mpc_config_bus *)mpt;
  195. MP_bus_info(m);
  196. mpt += sizeof(*m);
  197. count += sizeof(*m);
  198. break;
  199. }
  200. case MP_IOAPIC:
  201. {
  202. struct mpc_config_ioapic *m =
  203. (struct mpc_config_ioapic *)mpt;
  204. MP_ioapic_info(m);
  205. mpt += sizeof(*m);
  206. count += sizeof(*m);
  207. break;
  208. }
  209. case MP_INTSRC:
  210. {
  211. struct mpc_config_intsrc *m =
  212. (struct mpc_config_intsrc *)mpt;
  213. MP_intsrc_info(m);
  214. mpt += sizeof(*m);
  215. count += sizeof(*m);
  216. break;
  217. }
  218. case MP_LINTSRC:
  219. {
  220. struct mpc_config_lintsrc *m =
  221. (struct mpc_config_lintsrc *)mpt;
  222. MP_lintsrc_info(m);
  223. mpt += sizeof(*m);
  224. count += sizeof(*m);
  225. break;
  226. }
  227. }
  228. }
  229. setup_apic_routing();
  230. if (!num_processors)
  231. printk(KERN_ERR "MPTABLE: no processors registered!\n");
  232. return num_processors;
  233. }
  234. static int __init ELCR_trigger(unsigned int irq)
  235. {
  236. unsigned int port;
  237. port = 0x4d0 + (irq >> 3);
  238. return (inb(port) >> (irq & 7)) & 1;
  239. }
  240. static void __init construct_default_ioirq_mptable(int mpc_default_type)
  241. {
  242. struct mpc_config_intsrc intsrc;
  243. int i;
  244. int ELCR_fallback = 0;
  245. intsrc.mpc_type = MP_INTSRC;
  246. intsrc.mpc_irqflag = 0; /* conforming */
  247. intsrc.mpc_srcbus = 0;
  248. intsrc.mpc_dstapic = mp_ioapics[0].mpc_apicid;
  249. intsrc.mpc_irqtype = mp_INT;
  250. /*
  251. * If true, we have an ISA/PCI system with no IRQ entries
  252. * in the MP table. To prevent the PCI interrupts from being set up
  253. * incorrectly, we try to use the ELCR. The sanity check to see if
  254. * there is good ELCR data is very simple - IRQ0, 1, 2 and 13 can
  255. * never be level sensitive, so we simply see if the ELCR agrees.
  256. * If it does, we assume it's valid.
  257. */
  258. if (mpc_default_type == 5) {
  259. printk(KERN_INFO "ISA/PCI bus type with no IRQ information... "
  260. "falling back to ELCR\n");
  261. if (ELCR_trigger(0) || ELCR_trigger(1) || ELCR_trigger(2) ||
  262. ELCR_trigger(13))
  263. printk(KERN_ERR "ELCR contains invalid data... "
  264. "not using ELCR\n");
  265. else {
  266. printk(KERN_INFO
  267. "Using ELCR to identify PCI interrupts\n");
  268. ELCR_fallback = 1;
  269. }
  270. }
  271. for (i = 0; i < 16; i++) {
  272. switch (mpc_default_type) {
  273. case 2:
  274. if (i == 0 || i == 13)
  275. continue; /* IRQ0 & IRQ13 not connected */
  276. /* fall through */
  277. default:
  278. if (i == 2)
  279. continue; /* IRQ2 is never connected */
  280. }
  281. if (ELCR_fallback) {
  282. /*
  283. * If the ELCR indicates a level-sensitive interrupt, we
  284. * copy that information over to the MP table in the
  285. * irqflag field (level sensitive, active high polarity).
  286. */
  287. if (ELCR_trigger(i))
  288. intsrc.mpc_irqflag = 13;
  289. else
  290. intsrc.mpc_irqflag = 0;
  291. }
  292. intsrc.mpc_srcbusirq = i;
  293. intsrc.mpc_dstirq = i ? i : 2; /* IRQ0 to INTIN2 */
  294. MP_intsrc_info(&intsrc);
  295. }
  296. intsrc.mpc_irqtype = mp_ExtINT;
  297. intsrc.mpc_srcbusirq = 0;
  298. intsrc.mpc_dstirq = 0; /* 8259A to INTIN0 */
  299. MP_intsrc_info(&intsrc);
  300. }
  301. static inline void __init construct_default_ISA_mptable(int mpc_default_type)
  302. {
  303. struct mpc_config_processor processor;
  304. struct mpc_config_bus bus;
  305. struct mpc_config_ioapic ioapic;
  306. struct mpc_config_lintsrc lintsrc;
  307. int linttypes[2] = { mp_ExtINT, mp_NMI };
  308. int i;
  309. /*
  310. * local APIC has default address
  311. */
  312. mp_lapic_addr = APIC_DEFAULT_PHYS_BASE;
  313. /*
  314. * 2 CPUs, numbered 0 & 1.
  315. */
  316. processor.mpc_type = MP_PROCESSOR;
  317. processor.mpc_apicver = 0;
  318. processor.mpc_cpuflag = CPU_ENABLED;
  319. processor.mpc_cpufeature = 0;
  320. processor.mpc_featureflag = 0;
  321. processor.mpc_reserved[0] = 0;
  322. processor.mpc_reserved[1] = 0;
  323. for (i = 0; i < 2; i++) {
  324. processor.mpc_apicid = i;
  325. MP_processor_info(&processor);
  326. }
  327. bus.mpc_type = MP_BUS;
  328. bus.mpc_busid = 0;
  329. switch (mpc_default_type) {
  330. default:
  331. printk(KERN_ERR "???\nUnknown standard configuration %d\n",
  332. mpc_default_type);
  333. /* fall through */
  334. case 1:
  335. case 5:
  336. memcpy(bus.mpc_bustype, "ISA ", 6);
  337. break;
  338. }
  339. MP_bus_info(&bus);
  340. if (mpc_default_type > 4) {
  341. bus.mpc_busid = 1;
  342. memcpy(bus.mpc_bustype, "PCI ", 6);
  343. MP_bus_info(&bus);
  344. }
  345. ioapic.mpc_type = MP_IOAPIC;
  346. ioapic.mpc_apicid = 2;
  347. ioapic.mpc_apicver = 0;
  348. ioapic.mpc_flags = MPC_APIC_USABLE;
  349. ioapic.mpc_apicaddr = 0xFEC00000;
  350. MP_ioapic_info(&ioapic);
  351. /*
  352. * We set up most of the low 16 IO-APIC pins according to MPS rules.
  353. */
  354. construct_default_ioirq_mptable(mpc_default_type);
  355. lintsrc.mpc_type = MP_LINTSRC;
  356. lintsrc.mpc_irqflag = 0; /* conforming */
  357. lintsrc.mpc_srcbusid = 0;
  358. lintsrc.mpc_srcbusirq = 0;
  359. lintsrc.mpc_destapic = MP_APIC_ALL;
  360. for (i = 0; i < 2; i++) {
  361. lintsrc.mpc_irqtype = linttypes[i];
  362. lintsrc.mpc_destapiclint = i;
  363. MP_lintsrc_info(&lintsrc);
  364. }
  365. }
  366. static struct intel_mp_floating *mpf_found;
  367. /*
  368. * Scan the memory blocks for an SMP configuration block.
  369. */
  370. static void __init __get_smp_config(unsigned early)
  371. {
  372. struct intel_mp_floating *mpf = mpf_found;
  373. if (acpi_lapic && early)
  374. return;
  375. /*
  376. * ACPI supports both logical (e.g. Hyper-Threading) and physical
  377. * processors, where MPS only supports physical.
  378. */
  379. if (acpi_lapic && acpi_ioapic) {
  380. printk(KERN_INFO "Using ACPI (MADT) for SMP configuration "
  381. "information\n");
  382. return;
  383. } else if (acpi_lapic)
  384. printk(KERN_INFO "Using ACPI for processor (LAPIC) "
  385. "configuration information\n");
  386. printk(KERN_INFO "Intel MultiProcessor Specification v1.%d\n",
  387. mpf->mpf_specification);
  388. /*
  389. * Now see if we need to read further.
  390. */
  391. if (mpf->mpf_feature1 != 0) {
  392. if (early) {
  393. /*
  394. * local APIC has default address
  395. */
  396. mp_lapic_addr = APIC_DEFAULT_PHYS_BASE;
  397. return;
  398. }
  399. printk(KERN_INFO "Default MP configuration #%d\n",
  400. mpf->mpf_feature1);
  401. construct_default_ISA_mptable(mpf->mpf_feature1);
  402. } else if (mpf->mpf_physptr) {
  403. /*
  404. * Read the physical hardware table. Anything here will
  405. * override the defaults.
  406. */
  407. if (!smp_read_mpc(phys_to_virt(mpf->mpf_physptr), early)) {
  408. smp_found_config = 0;
  409. printk(KERN_ERR
  410. "BIOS bug, MP table errors detected!...\n");
  411. printk(KERN_ERR "... disabling SMP support. "
  412. "(tell your hw vendor)\n");
  413. return;
  414. }
  415. if (early)
  416. return;
  417. /*
  418. * If there are no explicit MP IRQ entries, then we are
  419. * broken. We set up most of the low 16 IO-APIC pins to
  420. * ISA defaults and hope it will work.
  421. */
  422. if (!mp_irq_entries) {
  423. struct mpc_config_bus bus;
  424. printk(KERN_ERR "BIOS bug, no explicit IRQ entries, "
  425. "using default mptable. "
  426. "(tell your hw vendor)\n");
  427. bus.mpc_type = MP_BUS;
  428. bus.mpc_busid = 0;
  429. memcpy(bus.mpc_bustype, "ISA ", 6);
  430. MP_bus_info(&bus);
  431. construct_default_ioirq_mptable(0);
  432. }
  433. } else
  434. BUG();
  435. if (!early)
  436. printk(KERN_INFO "Processors: %d\n", num_processors);
  437. /*
  438. * Only use the first configuration found.
  439. */
  440. }
  441. void __init early_get_smp_config(void)
  442. {
  443. __get_smp_config(1);
  444. }
  445. void __init get_smp_config(void)
  446. {
  447. __get_smp_config(0);
  448. }
  449. static int __init smp_scan_config(unsigned long base, unsigned long length,
  450. unsigned reserve)
  451. {
  452. extern void __bad_mpf_size(void);
  453. unsigned int *bp = phys_to_virt(base);
  454. struct intel_mp_floating *mpf;
  455. Dprintk("Scan SMP from %p for %ld bytes.\n", bp, length);
  456. if (sizeof(*mpf) != 16)
  457. __bad_mpf_size();
  458. while (length > 0) {
  459. mpf = (struct intel_mp_floating *)bp;
  460. if ((*bp == SMP_MAGIC_IDENT) &&
  461. (mpf->mpf_length == 1) &&
  462. !mpf_checksum((unsigned char *)bp, 16) &&
  463. ((mpf->mpf_specification == 1)
  464. || (mpf->mpf_specification == 4))) {
  465. smp_found_config = 1;
  466. mpf_found = mpf;
  467. if (!reserve)
  468. return 1;
  469. reserve_bootmem_generic(virt_to_phys(mpf), PAGE_SIZE);
  470. if (mpf->mpf_physptr)
  471. reserve_bootmem_generic(mpf->mpf_physptr,
  472. PAGE_SIZE);
  473. return 1;
  474. }
  475. bp += 4;
  476. length -= 16;
  477. }
  478. return 0;
  479. }
  480. static void __init __find_smp_config(unsigned reserve)
  481. {
  482. unsigned int address;
  483. /*
  484. * FIXME: Linux assumes you have 640K of base ram..
  485. * this continues the error...
  486. *
  487. * 1) Scan the bottom 1K for a signature
  488. * 2) Scan the top 1K of base RAM
  489. * 3) Scan the 64K of bios
  490. */
  491. if (smp_scan_config(0x0, 0x400, reserve) ||
  492. smp_scan_config(639 * 0x400, 0x400, reserve) ||
  493. smp_scan_config(0xF0000, 0x10000, reserve))
  494. return;
  495. /*
  496. * If it is an SMP machine we should know now.
  497. *
  498. * there is a real-mode segmented pointer pointing to the
  499. * 4K EBDA area at 0x40E, calculate and scan it here.
  500. *
  501. * NOTE! There are Linux loaders that will corrupt the EBDA
  502. * area, and as such this kind of SMP config may be less
  503. * trustworthy, simply because the SMP table may have been
  504. * stomped on during early boot. These loaders are buggy and
  505. * should be fixed.
  506. *
  507. * MP1.4 SPEC states to only scan first 1K of 4K EBDA.
  508. */
  509. address = get_bios_ebda();
  510. if (address)
  511. smp_scan_config(address, 0x400, reserve);
  512. }
  513. void __init early_find_smp_config(void)
  514. {
  515. __find_smp_config(0);
  516. }
  517. void __init find_smp_config(void)
  518. {
  519. __find_smp_config(1);
  520. }
  521. /* --------------------------------------------------------------------------
  522. ACPI-based MP Configuration
  523. -------------------------------------------------------------------------- */
  524. #ifdef CONFIG_ACPI
  525. void __init mp_register_lapic_address(u64 address)
  526. {
  527. mp_lapic_addr = (unsigned long)address;
  528. set_fixmap_nocache(FIX_APIC_BASE, mp_lapic_addr);
  529. if (boot_cpu_physical_apicid == -1U)
  530. boot_cpu_physical_apicid = GET_APIC_ID(read_apic_id());
  531. }
  532. void __cpuinit mp_register_lapic(int id, u8 enabled)
  533. {
  534. if (!enabled) {
  535. ++disabled_cpus;
  536. return;
  537. }
  538. generic_processor_info(id, 0);
  539. }
  540. #define MP_ISA_BUS 0
  541. #define MP_MAX_IOAPIC_PIN 127
  542. extern struct mp_ioapic_routing mp_ioapic_routing[MAX_IO_APICS];
  543. static int mp_find_ioapic(int gsi)
  544. {
  545. int i = 0;
  546. /* Find the IOAPIC that manages this GSI. */
  547. for (i = 0; i < nr_ioapics; i++) {
  548. if ((gsi >= mp_ioapic_routing[i].gsi_base)
  549. && (gsi <= mp_ioapic_routing[i].gsi_end))
  550. return i;
  551. }
  552. printk(KERN_ERR "ERROR: Unable to locate IOAPIC for GSI %d\n", gsi);
  553. return -1;
  554. }
  555. static u8 uniq_ioapic_id(u8 id)
  556. {
  557. int i;
  558. DECLARE_BITMAP(used, 256);
  559. bitmap_zero(used, 256);
  560. for (i = 0; i < nr_ioapics; i++) {
  561. struct mpc_config_ioapic *ia = &mp_ioapics[i];
  562. __set_bit(ia->mpc_apicid, used);
  563. }
  564. if (!test_bit(id, used))
  565. return id;
  566. return find_first_zero_bit(used, 256);
  567. }
  568. void __init mp_register_ioapic(int id, u32 address, u32 gsi_base)
  569. {
  570. int idx = 0;
  571. if (bad_ioapic(address))
  572. return;
  573. idx = nr_ioapics;
  574. mp_ioapics[idx].mpc_type = MP_IOAPIC;
  575. mp_ioapics[idx].mpc_flags = MPC_APIC_USABLE;
  576. mp_ioapics[idx].mpc_apicaddr = address;
  577. set_fixmap_nocache(FIX_IO_APIC_BASE_0 + idx, address);
  578. mp_ioapics[idx].mpc_apicid = uniq_ioapic_id(id);
  579. mp_ioapics[idx].mpc_apicver = 0;
  580. /*
  581. * Build basic IRQ lookup table to facilitate gsi->io_apic lookups
  582. * and to prevent reprogramming of IOAPIC pins (PCI IRQs).
  583. */
  584. mp_ioapic_routing[idx].apic_id = mp_ioapics[idx].mpc_apicid;
  585. mp_ioapic_routing[idx].gsi_base = gsi_base;
  586. mp_ioapic_routing[idx].gsi_end = gsi_base +
  587. io_apic_get_redir_entries(idx);
  588. printk(KERN_INFO "IOAPIC[%d]: apic_id %d, address 0x%x, "
  589. "GSI %d-%d\n", idx, mp_ioapics[idx].mpc_apicid,
  590. mp_ioapics[idx].mpc_apicaddr,
  591. mp_ioapic_routing[idx].gsi_base,
  592. mp_ioapic_routing[idx].gsi_end);
  593. nr_ioapics++;
  594. }
  595. void __init mp_override_legacy_irq(u8 bus_irq, u8 polarity, u8 trigger, u32 gsi)
  596. {
  597. struct mpc_config_intsrc intsrc;
  598. int ioapic = -1;
  599. int pin = -1;
  600. /*
  601. * Convert 'gsi' to 'ioapic.pin'.
  602. */
  603. ioapic = mp_find_ioapic(gsi);
  604. if (ioapic < 0)
  605. return;
  606. pin = gsi - mp_ioapic_routing[ioapic].gsi_base;
  607. /*
  608. * TBD: This check is for faulty timer entries, where the override
  609. * erroneously sets the trigger to level, resulting in a HUGE
  610. * increase of timer interrupts!
  611. */
  612. if ((bus_irq == 0) && (trigger == 3))
  613. trigger = 1;
  614. intsrc.mpc_type = MP_INTSRC;
  615. intsrc.mpc_irqtype = mp_INT;
  616. intsrc.mpc_irqflag = (trigger << 2) | polarity;
  617. intsrc.mpc_srcbus = MP_ISA_BUS;
  618. intsrc.mpc_srcbusirq = bus_irq; /* IRQ */
  619. intsrc.mpc_dstapic = mp_ioapics[ioapic].mpc_apicid; /* APIC ID */
  620. intsrc.mpc_dstirq = pin; /* INTIN# */
  621. Dprintk("Int: type %d, pol %d, trig %d, bus %d, irq %d, %d-%d\n",
  622. intsrc.mpc_irqtype, intsrc.mpc_irqflag & 3,
  623. (intsrc.mpc_irqflag >> 2) & 3, intsrc.mpc_srcbus,
  624. intsrc.mpc_srcbusirq, intsrc.mpc_dstapic, intsrc.mpc_dstirq);
  625. mp_irqs[mp_irq_entries] = intsrc;
  626. if (++mp_irq_entries == MAX_IRQ_SOURCES)
  627. panic("Max # of irq sources exceeded!\n");
  628. }
  629. void __init mp_config_acpi_legacy_irqs(void)
  630. {
  631. struct mpc_config_intsrc intsrc;
  632. int i = 0;
  633. int ioapic = -1;
  634. /*
  635. * Fabricate the legacy ISA bus (bus #31).
  636. */
  637. set_bit(MP_ISA_BUS, mp_bus_not_pci);
  638. /*
  639. * Locate the IOAPIC that manages the ISA IRQs (0-15).
  640. */
  641. ioapic = mp_find_ioapic(0);
  642. if (ioapic < 0)
  643. return;
  644. intsrc.mpc_type = MP_INTSRC;
  645. intsrc.mpc_irqflag = 0; /* Conforming */
  646. intsrc.mpc_srcbus = MP_ISA_BUS;
  647. intsrc.mpc_dstapic = mp_ioapics[ioapic].mpc_apicid;
  648. /*
  649. * Use the default configuration for the IRQs 0-15. Unless
  650. * overridden by (MADT) interrupt source override entries.
  651. */
  652. for (i = 0; i < 16; i++) {
  653. int idx;
  654. for (idx = 0; idx < mp_irq_entries; idx++) {
  655. struct mpc_config_intsrc *irq = mp_irqs + idx;
  656. /* Do we already have a mapping for this ISA IRQ? */
  657. if (irq->mpc_srcbus == MP_ISA_BUS
  658. && irq->mpc_srcbusirq == i)
  659. break;
  660. /* Do we already have a mapping for this IOAPIC pin */
  661. if ((irq->mpc_dstapic == intsrc.mpc_dstapic) &&
  662. (irq->mpc_dstirq == i))
  663. break;
  664. }
  665. if (idx != mp_irq_entries) {
  666. printk(KERN_DEBUG "ACPI: IRQ%d used by override.\n", i);
  667. continue; /* IRQ already used */
  668. }
  669. intsrc.mpc_irqtype = mp_INT;
  670. intsrc.mpc_srcbusirq = i; /* Identity mapped */
  671. intsrc.mpc_dstirq = i;
  672. Dprintk("Int: type %d, pol %d, trig %d, bus %d, irq %d, "
  673. "%d-%d\n", intsrc.mpc_irqtype, intsrc.mpc_irqflag & 3,
  674. (intsrc.mpc_irqflag >> 2) & 3, intsrc.mpc_srcbus,
  675. intsrc.mpc_srcbusirq, intsrc.mpc_dstapic,
  676. intsrc.mpc_dstirq);
  677. mp_irqs[mp_irq_entries] = intsrc;
  678. if (++mp_irq_entries == MAX_IRQ_SOURCES)
  679. panic("Max # of irq sources exceeded!\n");
  680. }
  681. }
  682. int mp_register_gsi(u32 gsi, int triggering, int polarity)
  683. {
  684. int ioapic = -1;
  685. int ioapic_pin = 0;
  686. int idx, bit = 0;
  687. if (acpi_irq_model != ACPI_IRQ_MODEL_IOAPIC)
  688. return gsi;
  689. /* Don't set up the ACPI SCI because it's already set up */
  690. if (acpi_gbl_FADT.sci_interrupt == gsi)
  691. return gsi;
  692. ioapic = mp_find_ioapic(gsi);
  693. if (ioapic < 0) {
  694. printk(KERN_WARNING "No IOAPIC for GSI %u\n", gsi);
  695. return gsi;
  696. }
  697. ioapic_pin = gsi - mp_ioapic_routing[ioapic].gsi_base;
  698. /*
  699. * Avoid pin reprogramming. PRTs typically include entries
  700. * with redundant pin->gsi mappings (but unique PCI devices);
  701. * we only program the IOAPIC on the first.
  702. */
  703. bit = ioapic_pin % 32;
  704. idx = (ioapic_pin < 32) ? 0 : (ioapic_pin / 32);
  705. if (idx > 3) {
  706. printk(KERN_ERR "Invalid reference to IOAPIC pin "
  707. "%d-%d\n", mp_ioapic_routing[ioapic].apic_id,
  708. ioapic_pin);
  709. return gsi;
  710. }
  711. if ((1 << bit) & mp_ioapic_routing[ioapic].pin_programmed[idx]) {
  712. Dprintk(KERN_DEBUG "Pin %d-%d already programmed\n",
  713. mp_ioapic_routing[ioapic].apic_id, ioapic_pin);
  714. return gsi;
  715. }
  716. mp_ioapic_routing[ioapic].pin_programmed[idx] |= (1 << bit);
  717. io_apic_set_pci_routing(ioapic, ioapic_pin, gsi,
  718. triggering == ACPI_EDGE_SENSITIVE ? 0 : 1,
  719. polarity == ACPI_ACTIVE_HIGH ? 0 : 1);
  720. return gsi;
  721. }
  722. #endif /* CONFIG_ACPI */