irq.c 31 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173
  1. /*
  2. * Low-Level PCI Support for PC -- Routing of Interrupts
  3. *
  4. * (c) 1999--2000 Martin Mares <mj@ucw.cz>
  5. */
  6. #include <linux/config.h>
  7. #include <linux/types.h>
  8. #include <linux/kernel.h>
  9. #include <linux/pci.h>
  10. #include <linux/init.h>
  11. #include <linux/slab.h>
  12. #include <linux/interrupt.h>
  13. #include <linux/dmi.h>
  14. #include <asm/io.h>
  15. #include <asm/smp.h>
  16. #include <asm/io_apic.h>
  17. #include <linux/irq.h>
  18. #include <linux/acpi.h>
  19. #include "pci.h"
  20. #define PIRQ_SIGNATURE (('$' << 0) + ('P' << 8) + ('I' << 16) + ('R' << 24))
  21. #define PIRQ_VERSION 0x0100
  22. static int broken_hp_bios_irq9;
  23. static int acer_tm360_irqrouting;
  24. static struct irq_routing_table *pirq_table;
  25. static int pirq_enable_irq(struct pci_dev *dev);
  26. /*
  27. * Never use: 0, 1, 2 (timer, keyboard, and cascade)
  28. * Avoid using: 13, 14 and 15 (FP error and IDE).
  29. * Penalize: 3, 4, 6, 7, 12 (known ISA uses: serial, floppy, parallel and mouse)
  30. */
  31. unsigned int pcibios_irq_mask = 0xfff8;
  32. static int pirq_penalty[16] = {
  33. 1000000, 1000000, 1000000, 1000, 1000, 0, 1000, 1000,
  34. 0, 0, 0, 0, 1000, 100000, 100000, 100000
  35. };
  36. struct irq_router {
  37. char *name;
  38. u16 vendor, device;
  39. int (*get)(struct pci_dev *router, struct pci_dev *dev, int pirq);
  40. int (*set)(struct pci_dev *router, struct pci_dev *dev, int pirq, int new);
  41. };
  42. struct irq_router_handler {
  43. u16 vendor;
  44. int (*probe)(struct irq_router *r, struct pci_dev *router, u16 device);
  45. };
  46. int (*pcibios_enable_irq)(struct pci_dev *dev) = NULL;
  47. void (*pcibios_disable_irq)(struct pci_dev *dev) = NULL;
  48. /*
  49. * Check passed address for the PCI IRQ Routing Table signature
  50. * and perform checksum verification.
  51. */
  52. static inline struct irq_routing_table * pirq_check_routing_table(u8 *addr)
  53. {
  54. struct irq_routing_table *rt;
  55. int i;
  56. u8 sum;
  57. rt = (struct irq_routing_table *) addr;
  58. if (rt->signature != PIRQ_SIGNATURE ||
  59. rt->version != PIRQ_VERSION ||
  60. rt->size % 16 ||
  61. rt->size < sizeof(struct irq_routing_table))
  62. return NULL;
  63. sum = 0;
  64. for (i=0; i < rt->size; i++)
  65. sum += addr[i];
  66. if (!sum) {
  67. DBG("PCI: Interrupt Routing Table found at 0x%p\n", rt);
  68. return rt;
  69. }
  70. return NULL;
  71. }
  72. /*
  73. * Search 0xf0000 -- 0xfffff for the PCI IRQ Routing Table.
  74. */
  75. static struct irq_routing_table * __init pirq_find_routing_table(void)
  76. {
  77. u8 *addr;
  78. struct irq_routing_table *rt;
  79. if (pirq_table_addr) {
  80. rt = pirq_check_routing_table((u8 *) __va(pirq_table_addr));
  81. if (rt)
  82. return rt;
  83. printk(KERN_WARNING "PCI: PIRQ table NOT found at pirqaddr\n");
  84. }
  85. for(addr = (u8 *) __va(0xf0000); addr < (u8 *) __va(0x100000); addr += 16) {
  86. rt = pirq_check_routing_table(addr);
  87. if (rt)
  88. return rt;
  89. }
  90. return NULL;
  91. }
  92. /*
  93. * If we have a IRQ routing table, use it to search for peer host
  94. * bridges. It's a gross hack, but since there are no other known
  95. * ways how to get a list of buses, we have to go this way.
  96. */
  97. static void __init pirq_peer_trick(void)
  98. {
  99. struct irq_routing_table *rt = pirq_table;
  100. u8 busmap[256];
  101. int i;
  102. struct irq_info *e;
  103. memset(busmap, 0, sizeof(busmap));
  104. for(i=0; i < (rt->size - sizeof(struct irq_routing_table)) / sizeof(struct irq_info); i++) {
  105. e = &rt->slots[i];
  106. #ifdef DEBUG
  107. {
  108. int j;
  109. DBG("%02x:%02x slot=%02x", e->bus, e->devfn/8, e->slot);
  110. for(j=0; j<4; j++)
  111. DBG(" %d:%02x/%04x", j, e->irq[j].link, e->irq[j].bitmap);
  112. DBG("\n");
  113. }
  114. #endif
  115. busmap[e->bus] = 1;
  116. }
  117. for(i = 1; i < 256; i++) {
  118. if (!busmap[i] || pci_find_bus(0, i))
  119. continue;
  120. if (pci_scan_bus(i, &pci_root_ops, NULL))
  121. printk(KERN_INFO "PCI: Discovered primary peer bus %02x [IRQ]\n", i);
  122. }
  123. pcibios_last_bus = -1;
  124. }
  125. /*
  126. * Code for querying and setting of IRQ routes on various interrupt routers.
  127. */
  128. void eisa_set_level_irq(unsigned int irq)
  129. {
  130. unsigned char mask = 1 << (irq & 7);
  131. unsigned int port = 0x4d0 + (irq >> 3);
  132. unsigned char val;
  133. static u16 eisa_irq_mask;
  134. if (irq >= 16 || (1 << irq) & eisa_irq_mask)
  135. return;
  136. eisa_irq_mask |= (1 << irq);
  137. printk("PCI: setting IRQ %u as level-triggered\n", irq);
  138. val = inb(port);
  139. if (!(val & mask)) {
  140. DBG(" -> edge");
  141. outb(val | mask, port);
  142. }
  143. }
  144. /*
  145. * Common IRQ routing practice: nybbles in config space,
  146. * offset by some magic constant.
  147. */
  148. static unsigned int read_config_nybble(struct pci_dev *router, unsigned offset, unsigned nr)
  149. {
  150. u8 x;
  151. unsigned reg = offset + (nr >> 1);
  152. pci_read_config_byte(router, reg, &x);
  153. return (nr & 1) ? (x >> 4) : (x & 0xf);
  154. }
  155. static void write_config_nybble(struct pci_dev *router, unsigned offset, unsigned nr, unsigned int val)
  156. {
  157. u8 x;
  158. unsigned reg = offset + (nr >> 1);
  159. pci_read_config_byte(router, reg, &x);
  160. x = (nr & 1) ? ((x & 0x0f) | (val << 4)) : ((x & 0xf0) | val);
  161. pci_write_config_byte(router, reg, x);
  162. }
  163. /*
  164. * ALI pirq entries are damn ugly, and completely undocumented.
  165. * This has been figured out from pirq tables, and it's not a pretty
  166. * picture.
  167. */
  168. static int pirq_ali_get(struct pci_dev *router, struct pci_dev *dev, int pirq)
  169. {
  170. static unsigned char irqmap[16] = { 0, 9, 3, 10, 4, 5, 7, 6, 1, 11, 0, 12, 0, 14, 0, 15 };
  171. return irqmap[read_config_nybble(router, 0x48, pirq-1)];
  172. }
  173. static int pirq_ali_set(struct pci_dev *router, struct pci_dev *dev, int pirq, int irq)
  174. {
  175. static unsigned char irqmap[16] = { 0, 8, 0, 2, 4, 5, 7, 6, 0, 1, 3, 9, 11, 0, 13, 15 };
  176. unsigned int val = irqmap[irq];
  177. if (val) {
  178. write_config_nybble(router, 0x48, pirq-1, val);
  179. return 1;
  180. }
  181. return 0;
  182. }
  183. /*
  184. * The Intel PIIX4 pirq rules are fairly simple: "pirq" is
  185. * just a pointer to the config space.
  186. */
  187. static int pirq_piix_get(struct pci_dev *router, struct pci_dev *dev, int pirq)
  188. {
  189. u8 x;
  190. pci_read_config_byte(router, pirq, &x);
  191. return (x < 16) ? x : 0;
  192. }
  193. static int pirq_piix_set(struct pci_dev *router, struct pci_dev *dev, int pirq, int irq)
  194. {
  195. pci_write_config_byte(router, pirq, irq);
  196. return 1;
  197. }
  198. /*
  199. * The VIA pirq rules are nibble-based, like ALI,
  200. * but without the ugly irq number munging.
  201. * However, PIRQD is in the upper instead of lower 4 bits.
  202. */
  203. static int pirq_via_get(struct pci_dev *router, struct pci_dev *dev, int pirq)
  204. {
  205. return read_config_nybble(router, 0x55, pirq == 4 ? 5 : pirq);
  206. }
  207. static int pirq_via_set(struct pci_dev *router, struct pci_dev *dev, int pirq, int irq)
  208. {
  209. write_config_nybble(router, 0x55, pirq == 4 ? 5 : pirq, irq);
  210. return 1;
  211. }
  212. /*
  213. * The VIA pirq rules are nibble-based, like ALI,
  214. * but without the ugly irq number munging.
  215. * However, for 82C586, nibble map is different .
  216. */
  217. static int pirq_via586_get(struct pci_dev *router, struct pci_dev *dev, int pirq)
  218. {
  219. static unsigned int pirqmap[4] = { 3, 2, 5, 1 };
  220. return read_config_nybble(router, 0x55, pirqmap[pirq-1]);
  221. }
  222. static int pirq_via586_set(struct pci_dev *router, struct pci_dev *dev, int pirq, int irq)
  223. {
  224. static unsigned int pirqmap[4] = { 3, 2, 5, 1 };
  225. write_config_nybble(router, 0x55, pirqmap[pirq-1], irq);
  226. return 1;
  227. }
  228. /*
  229. * ITE 8330G pirq rules are nibble-based
  230. * FIXME: pirqmap may be { 1, 0, 3, 2 },
  231. * 2+3 are both mapped to irq 9 on my system
  232. */
  233. static int pirq_ite_get(struct pci_dev *router, struct pci_dev *dev, int pirq)
  234. {
  235. static unsigned char pirqmap[4] = { 1, 0, 2, 3 };
  236. return read_config_nybble(router,0x43, pirqmap[pirq-1]);
  237. }
  238. static int pirq_ite_set(struct pci_dev *router, struct pci_dev *dev, int pirq, int irq)
  239. {
  240. static unsigned char pirqmap[4] = { 1, 0, 2, 3 };
  241. write_config_nybble(router, 0x43, pirqmap[pirq-1], irq);
  242. return 1;
  243. }
  244. /*
  245. * OPTI: high four bits are nibble pointer..
  246. * I wonder what the low bits do?
  247. */
  248. static int pirq_opti_get(struct pci_dev *router, struct pci_dev *dev, int pirq)
  249. {
  250. return read_config_nybble(router, 0xb8, pirq >> 4);
  251. }
  252. static int pirq_opti_set(struct pci_dev *router, struct pci_dev *dev, int pirq, int irq)
  253. {
  254. write_config_nybble(router, 0xb8, pirq >> 4, irq);
  255. return 1;
  256. }
  257. /*
  258. * Cyrix: nibble offset 0x5C
  259. * 0x5C bits 7:4 is INTB bits 3:0 is INTA
  260. * 0x5D bits 7:4 is INTD bits 3:0 is INTC
  261. */
  262. static int pirq_cyrix_get(struct pci_dev *router, struct pci_dev *dev, int pirq)
  263. {
  264. return read_config_nybble(router, 0x5C, (pirq-1)^1);
  265. }
  266. static int pirq_cyrix_set(struct pci_dev *router, struct pci_dev *dev, int pirq, int irq)
  267. {
  268. write_config_nybble(router, 0x5C, (pirq-1)^1, irq);
  269. return 1;
  270. }
  271. /*
  272. * PIRQ routing for SiS 85C503 router used in several SiS chipsets.
  273. * We have to deal with the following issues here:
  274. * - vendors have different ideas about the meaning of link values
  275. * - some onboard devices (integrated in the chipset) have special
  276. * links and are thus routed differently (i.e. not via PCI INTA-INTD)
  277. * - different revision of the router have a different layout for
  278. * the routing registers, particularly for the onchip devices
  279. *
  280. * For all routing registers the common thing is we have one byte
  281. * per routeable link which is defined as:
  282. * bit 7 IRQ mapping enabled (0) or disabled (1)
  283. * bits [6:4] reserved (sometimes used for onchip devices)
  284. * bits [3:0] IRQ to map to
  285. * allowed: 3-7, 9-12, 14-15
  286. * reserved: 0, 1, 2, 8, 13
  287. *
  288. * The config-space registers located at 0x41/0x42/0x43/0x44 are
  289. * always used to route the normal PCI INT A/B/C/D respectively.
  290. * Apparently there are systems implementing PCI routing table using
  291. * link values 0x01-0x04 and others using 0x41-0x44 for PCI INTA..D.
  292. * We try our best to handle both link mappings.
  293. *
  294. * Currently (2003-05-21) it appears most SiS chipsets follow the
  295. * definition of routing registers from the SiS-5595 southbridge.
  296. * According to the SiS 5595 datasheets the revision id's of the
  297. * router (ISA-bridge) should be 0x01 or 0xb0.
  298. *
  299. * Furthermore we've also seen lspci dumps with revision 0x00 and 0xb1.
  300. * Looks like these are used in a number of SiS 5xx/6xx/7xx chipsets.
  301. * They seem to work with the current routing code. However there is
  302. * some concern because of the two USB-OHCI HCs (original SiS 5595
  303. * had only one). YMMV.
  304. *
  305. * Onchip routing for router rev-id 0x01/0xb0 and probably 0x00/0xb1:
  306. *
  307. * 0x61: IDEIRQ:
  308. * bits [6:5] must be written 01
  309. * bit 4 channel-select primary (0), secondary (1)
  310. *
  311. * 0x62: USBIRQ:
  312. * bit 6 OHCI function disabled (0), enabled (1)
  313. *
  314. * 0x6a: ACPI/SCI IRQ: bits 4-6 reserved
  315. *
  316. * 0x7e: Data Acq. Module IRQ - bits 4-6 reserved
  317. *
  318. * We support USBIRQ (in addition to INTA-INTD) and keep the
  319. * IDE, ACPI and DAQ routing untouched as set by the BIOS.
  320. *
  321. * Currently the only reported exception is the new SiS 65x chipset
  322. * which includes the SiS 69x southbridge. Here we have the 85C503
  323. * router revision 0x04 and there are changes in the register layout
  324. * mostly related to the different USB HCs with USB 2.0 support.
  325. *
  326. * Onchip routing for router rev-id 0x04 (try-and-error observation)
  327. *
  328. * 0x60/0x61/0x62/0x63: 1xEHCI and 3xOHCI (companion) USB-HCs
  329. * bit 6-4 are probably unused, not like 5595
  330. */
  331. #define PIRQ_SIS_IRQ_MASK 0x0f
  332. #define PIRQ_SIS_IRQ_DISABLE 0x80
  333. #define PIRQ_SIS_USB_ENABLE 0x40
  334. static int pirq_sis_get(struct pci_dev *router, struct pci_dev *dev, int pirq)
  335. {
  336. u8 x;
  337. int reg;
  338. reg = pirq;
  339. if (reg >= 0x01 && reg <= 0x04)
  340. reg += 0x40;
  341. pci_read_config_byte(router, reg, &x);
  342. return (x & PIRQ_SIS_IRQ_DISABLE) ? 0 : (x & PIRQ_SIS_IRQ_MASK);
  343. }
  344. static int pirq_sis_set(struct pci_dev *router, struct pci_dev *dev, int pirq, int irq)
  345. {
  346. u8 x;
  347. int reg;
  348. reg = pirq;
  349. if (reg >= 0x01 && reg <= 0x04)
  350. reg += 0x40;
  351. pci_read_config_byte(router, reg, &x);
  352. x &= ~(PIRQ_SIS_IRQ_MASK | PIRQ_SIS_IRQ_DISABLE);
  353. x |= irq ? irq: PIRQ_SIS_IRQ_DISABLE;
  354. pci_write_config_byte(router, reg, x);
  355. return 1;
  356. }
  357. /*
  358. * VLSI: nibble offset 0x74 - educated guess due to routing table and
  359. * config space of VLSI 82C534 PCI-bridge/router (1004:0102)
  360. * Tested on HP OmniBook 800 covering PIRQ 1, 2, 4, 8 for onboard
  361. * devices, PIRQ 3 for non-pci(!) soundchip and (untested) PIRQ 6
  362. * for the busbridge to the docking station.
  363. */
  364. static int pirq_vlsi_get(struct pci_dev *router, struct pci_dev *dev, int pirq)
  365. {
  366. if (pirq > 8) {
  367. printk(KERN_INFO "VLSI router pirq escape (%d)\n", pirq);
  368. return 0;
  369. }
  370. return read_config_nybble(router, 0x74, pirq-1);
  371. }
  372. static int pirq_vlsi_set(struct pci_dev *router, struct pci_dev *dev, int pirq, int irq)
  373. {
  374. if (pirq > 8) {
  375. printk(KERN_INFO "VLSI router pirq escape (%d)\n", pirq);
  376. return 0;
  377. }
  378. write_config_nybble(router, 0x74, pirq-1, irq);
  379. return 1;
  380. }
  381. /*
  382. * ServerWorks: PCI interrupts mapped to system IRQ lines through Index
  383. * and Redirect I/O registers (0x0c00 and 0x0c01). The Index register
  384. * format is (PCIIRQ## | 0x10), e.g.: PCIIRQ10=0x1a. The Redirect
  385. * register is a straight binary coding of desired PIC IRQ (low nibble).
  386. *
  387. * The 'link' value in the PIRQ table is already in the correct format
  388. * for the Index register. There are some special index values:
  389. * 0x00 for ACPI (SCI), 0x01 for USB, 0x02 for IDE0, 0x04 for IDE1,
  390. * and 0x03 for SMBus.
  391. */
  392. static int pirq_serverworks_get(struct pci_dev *router, struct pci_dev *dev, int pirq)
  393. {
  394. outb_p(pirq, 0xc00);
  395. return inb(0xc01) & 0xf;
  396. }
  397. static int pirq_serverworks_set(struct pci_dev *router, struct pci_dev *dev, int pirq, int irq)
  398. {
  399. outb_p(pirq, 0xc00);
  400. outb_p(irq, 0xc01);
  401. return 1;
  402. }
  403. /* Support for AMD756 PCI IRQ Routing
  404. * Jhon H. Caicedo <jhcaiced@osso.org.co>
  405. * Jun/21/2001 0.2.0 Release, fixed to use "nybble" functions... (jhcaiced)
  406. * Jun/19/2001 Alpha Release 0.1.0 (jhcaiced)
  407. * The AMD756 pirq rules are nibble-based
  408. * offset 0x56 0-3 PIRQA 4-7 PIRQB
  409. * offset 0x57 0-3 PIRQC 4-7 PIRQD
  410. */
  411. static int pirq_amd756_get(struct pci_dev *router, struct pci_dev *dev, int pirq)
  412. {
  413. u8 irq;
  414. irq = 0;
  415. if (pirq <= 4)
  416. {
  417. irq = read_config_nybble(router, 0x56, pirq - 1);
  418. }
  419. printk(KERN_INFO "AMD756: dev %04x:%04x, router pirq : %d get irq : %2d\n",
  420. dev->vendor, dev->device, pirq, irq);
  421. return irq;
  422. }
  423. static int pirq_amd756_set(struct pci_dev *router, struct pci_dev *dev, int pirq, int irq)
  424. {
  425. printk(KERN_INFO "AMD756: dev %04x:%04x, router pirq : %d SET irq : %2d\n",
  426. dev->vendor, dev->device, pirq, irq);
  427. if (pirq <= 4)
  428. {
  429. write_config_nybble(router, 0x56, pirq - 1, irq);
  430. }
  431. return 1;
  432. }
  433. #ifdef CONFIG_PCI_BIOS
  434. static int pirq_bios_set(struct pci_dev *router, struct pci_dev *dev, int pirq, int irq)
  435. {
  436. struct pci_dev *bridge;
  437. int pin = pci_get_interrupt_pin(dev, &bridge);
  438. return pcibios_set_irq_routing(bridge, pin, irq);
  439. }
  440. #endif
  441. static __init int intel_router_probe(struct irq_router *r, struct pci_dev *router, u16 device)
  442. {
  443. static struct pci_device_id pirq_440gx[] = {
  444. { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_82443GX_0) },
  445. { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_82443GX_2) },
  446. { },
  447. };
  448. /* 440GX has a proprietary PIRQ router -- don't use it */
  449. if (pci_dev_present(pirq_440gx))
  450. return 0;
  451. switch(device)
  452. {
  453. case PCI_DEVICE_ID_INTEL_82371FB_0:
  454. case PCI_DEVICE_ID_INTEL_82371SB_0:
  455. case PCI_DEVICE_ID_INTEL_82371AB_0:
  456. case PCI_DEVICE_ID_INTEL_82371MX:
  457. case PCI_DEVICE_ID_INTEL_82443MX_0:
  458. case PCI_DEVICE_ID_INTEL_82801AA_0:
  459. case PCI_DEVICE_ID_INTEL_82801AB_0:
  460. case PCI_DEVICE_ID_INTEL_82801BA_0:
  461. case PCI_DEVICE_ID_INTEL_82801BA_10:
  462. case PCI_DEVICE_ID_INTEL_82801CA_0:
  463. case PCI_DEVICE_ID_INTEL_82801CA_12:
  464. case PCI_DEVICE_ID_INTEL_82801DB_0:
  465. case PCI_DEVICE_ID_INTEL_82801E_0:
  466. case PCI_DEVICE_ID_INTEL_82801EB_0:
  467. case PCI_DEVICE_ID_INTEL_ESB_1:
  468. case PCI_DEVICE_ID_INTEL_ICH6_0:
  469. case PCI_DEVICE_ID_INTEL_ICH6_1:
  470. case PCI_DEVICE_ID_INTEL_ICH7_0:
  471. case PCI_DEVICE_ID_INTEL_ICH7_1:
  472. case PCI_DEVICE_ID_INTEL_ICH7_30:
  473. case PCI_DEVICE_ID_INTEL_ICH7_31:
  474. case PCI_DEVICE_ID_INTEL_ESB2_0:
  475. r->name = "PIIX/ICH";
  476. r->get = pirq_piix_get;
  477. r->set = pirq_piix_set;
  478. return 1;
  479. }
  480. return 0;
  481. }
  482. static __init int via_router_probe(struct irq_router *r, struct pci_dev *router, u16 device)
  483. {
  484. /* FIXME: We should move some of the quirk fixup stuff here */
  485. if (router->device == PCI_DEVICE_ID_VIA_82C686 &&
  486. device == PCI_DEVICE_ID_VIA_82C586_0) {
  487. /* Asus k7m bios wrongly reports 82C686A as 586-compatible */
  488. device = PCI_DEVICE_ID_VIA_82C686;
  489. }
  490. switch(device)
  491. {
  492. case PCI_DEVICE_ID_VIA_82C586_0:
  493. r->name = "VIA";
  494. r->get = pirq_via586_get;
  495. r->set = pirq_via586_set;
  496. return 1;
  497. case PCI_DEVICE_ID_VIA_82C596:
  498. case PCI_DEVICE_ID_VIA_82C686:
  499. case PCI_DEVICE_ID_VIA_8231:
  500. /* FIXME: add new ones for 8233/5 */
  501. r->name = "VIA";
  502. r->get = pirq_via_get;
  503. r->set = pirq_via_set;
  504. return 1;
  505. }
  506. return 0;
  507. }
  508. static __init int vlsi_router_probe(struct irq_router *r, struct pci_dev *router, u16 device)
  509. {
  510. switch(device)
  511. {
  512. case PCI_DEVICE_ID_VLSI_82C534:
  513. r->name = "VLSI 82C534";
  514. r->get = pirq_vlsi_get;
  515. r->set = pirq_vlsi_set;
  516. return 1;
  517. }
  518. return 0;
  519. }
  520. static __init int serverworks_router_probe(struct irq_router *r, struct pci_dev *router, u16 device)
  521. {
  522. switch(device)
  523. {
  524. case PCI_DEVICE_ID_SERVERWORKS_OSB4:
  525. case PCI_DEVICE_ID_SERVERWORKS_CSB5:
  526. r->name = "ServerWorks";
  527. r->get = pirq_serverworks_get;
  528. r->set = pirq_serverworks_set;
  529. return 1;
  530. }
  531. return 0;
  532. }
  533. static __init int sis_router_probe(struct irq_router *r, struct pci_dev *router, u16 device)
  534. {
  535. if (device != PCI_DEVICE_ID_SI_503)
  536. return 0;
  537. r->name = "SIS";
  538. r->get = pirq_sis_get;
  539. r->set = pirq_sis_set;
  540. return 1;
  541. }
  542. static __init int cyrix_router_probe(struct irq_router *r, struct pci_dev *router, u16 device)
  543. {
  544. switch(device)
  545. {
  546. case PCI_DEVICE_ID_CYRIX_5520:
  547. r->name = "NatSemi";
  548. r->get = pirq_cyrix_get;
  549. r->set = pirq_cyrix_set;
  550. return 1;
  551. }
  552. return 0;
  553. }
  554. static __init int opti_router_probe(struct irq_router *r, struct pci_dev *router, u16 device)
  555. {
  556. switch(device)
  557. {
  558. case PCI_DEVICE_ID_OPTI_82C700:
  559. r->name = "OPTI";
  560. r->get = pirq_opti_get;
  561. r->set = pirq_opti_set;
  562. return 1;
  563. }
  564. return 0;
  565. }
  566. static __init int ite_router_probe(struct irq_router *r, struct pci_dev *router, u16 device)
  567. {
  568. switch(device)
  569. {
  570. case PCI_DEVICE_ID_ITE_IT8330G_0:
  571. r->name = "ITE";
  572. r->get = pirq_ite_get;
  573. r->set = pirq_ite_set;
  574. return 1;
  575. }
  576. return 0;
  577. }
  578. static __init int ali_router_probe(struct irq_router *r, struct pci_dev *router, u16 device)
  579. {
  580. switch(device)
  581. {
  582. case PCI_DEVICE_ID_AL_M1533:
  583. case PCI_DEVICE_ID_AL_M1563:
  584. printk("PCI: Using ALI IRQ Router\n");
  585. r->name = "ALI";
  586. r->get = pirq_ali_get;
  587. r->set = pirq_ali_set;
  588. return 1;
  589. }
  590. return 0;
  591. }
  592. static __init int amd_router_probe(struct irq_router *r, struct pci_dev *router, u16 device)
  593. {
  594. switch(device)
  595. {
  596. case PCI_DEVICE_ID_AMD_VIPER_740B:
  597. r->name = "AMD756";
  598. break;
  599. case PCI_DEVICE_ID_AMD_VIPER_7413:
  600. r->name = "AMD766";
  601. break;
  602. case PCI_DEVICE_ID_AMD_VIPER_7443:
  603. r->name = "AMD768";
  604. break;
  605. default:
  606. return 0;
  607. }
  608. r->get = pirq_amd756_get;
  609. r->set = pirq_amd756_set;
  610. return 1;
  611. }
  612. static __initdata struct irq_router_handler pirq_routers[] = {
  613. { PCI_VENDOR_ID_INTEL, intel_router_probe },
  614. { PCI_VENDOR_ID_AL, ali_router_probe },
  615. { PCI_VENDOR_ID_ITE, ite_router_probe },
  616. { PCI_VENDOR_ID_VIA, via_router_probe },
  617. { PCI_VENDOR_ID_OPTI, opti_router_probe },
  618. { PCI_VENDOR_ID_SI, sis_router_probe },
  619. { PCI_VENDOR_ID_CYRIX, cyrix_router_probe },
  620. { PCI_VENDOR_ID_VLSI, vlsi_router_probe },
  621. { PCI_VENDOR_ID_SERVERWORKS, serverworks_router_probe },
  622. { PCI_VENDOR_ID_AMD, amd_router_probe },
  623. /* Someone with docs needs to add the ATI Radeon IGP */
  624. { 0, NULL }
  625. };
  626. static struct irq_router pirq_router;
  627. static struct pci_dev *pirq_router_dev;
  628. /*
  629. * FIXME: should we have an option to say "generic for
  630. * chipset" ?
  631. */
  632. static void __init pirq_find_router(struct irq_router *r)
  633. {
  634. struct irq_routing_table *rt = pirq_table;
  635. struct irq_router_handler *h;
  636. #ifdef CONFIG_PCI_BIOS
  637. if (!rt->signature) {
  638. printk(KERN_INFO "PCI: Using BIOS for IRQ routing\n");
  639. r->set = pirq_bios_set;
  640. r->name = "BIOS";
  641. return;
  642. }
  643. #endif
  644. /* Default unless a driver reloads it */
  645. r->name = "default";
  646. r->get = NULL;
  647. r->set = NULL;
  648. DBG("PCI: Attempting to find IRQ router for %04x:%04x\n",
  649. rt->rtr_vendor, rt->rtr_device);
  650. pirq_router_dev = pci_find_slot(rt->rtr_bus, rt->rtr_devfn);
  651. if (!pirq_router_dev) {
  652. DBG("PCI: Interrupt router not found at %02x:%02x\n", rt->rtr_bus, rt->rtr_devfn);
  653. return;
  654. }
  655. for( h = pirq_routers; h->vendor; h++) {
  656. /* First look for a router match */
  657. if (rt->rtr_vendor == h->vendor && h->probe(r, pirq_router_dev, rt->rtr_device))
  658. break;
  659. /* Fall back to a device match */
  660. if (pirq_router_dev->vendor == h->vendor && h->probe(r, pirq_router_dev, pirq_router_dev->device))
  661. break;
  662. }
  663. printk(KERN_INFO "PCI: Using IRQ router %s [%04x/%04x] at %s\n",
  664. pirq_router.name,
  665. pirq_router_dev->vendor,
  666. pirq_router_dev->device,
  667. pci_name(pirq_router_dev));
  668. }
  669. static struct irq_info *pirq_get_info(struct pci_dev *dev)
  670. {
  671. struct irq_routing_table *rt = pirq_table;
  672. int entries = (rt->size - sizeof(struct irq_routing_table)) / sizeof(struct irq_info);
  673. struct irq_info *info;
  674. for (info = rt->slots; entries--; info++)
  675. if (info->bus == dev->bus->number && PCI_SLOT(info->devfn) == PCI_SLOT(dev->devfn))
  676. return info;
  677. return NULL;
  678. }
  679. static int pcibios_lookup_irq(struct pci_dev *dev, int assign)
  680. {
  681. u8 pin;
  682. struct irq_info *info;
  683. int i, pirq, newirq;
  684. int irq = 0;
  685. u32 mask;
  686. struct irq_router *r = &pirq_router;
  687. struct pci_dev *dev2 = NULL;
  688. char *msg = NULL;
  689. /* Find IRQ pin */
  690. pci_read_config_byte(dev, PCI_INTERRUPT_PIN, &pin);
  691. if (!pin) {
  692. DBG(" -> no interrupt pin\n");
  693. return 0;
  694. }
  695. pin = pin - 1;
  696. /* Find IRQ routing entry */
  697. if (!pirq_table)
  698. return 0;
  699. DBG("IRQ for %s[%c]", pci_name(dev), 'A' + pin);
  700. info = pirq_get_info(dev);
  701. if (!info) {
  702. DBG(" -> not found in routing table\n");
  703. return 0;
  704. }
  705. pirq = info->irq[pin].link;
  706. mask = info->irq[pin].bitmap;
  707. if (!pirq) {
  708. DBG(" -> not routed\n");
  709. return 0;
  710. }
  711. DBG(" -> PIRQ %02x, mask %04x, excl %04x", pirq, mask, pirq_table->exclusive_irqs);
  712. mask &= pcibios_irq_mask;
  713. /* Work around broken HP Pavilion Notebooks which assign USB to
  714. IRQ 9 even though it is actually wired to IRQ 11 */
  715. if (broken_hp_bios_irq9 && pirq == 0x59 && dev->irq == 9) {
  716. dev->irq = 11;
  717. pci_write_config_byte(dev, PCI_INTERRUPT_LINE, 11);
  718. r->set(pirq_router_dev, dev, pirq, 11);
  719. }
  720. /* same for Acer Travelmate 360, but with CB and irq 11 -> 10 */
  721. if (acer_tm360_irqrouting && dev->irq == 11 && dev->vendor == PCI_VENDOR_ID_O2) {
  722. pirq = 0x68;
  723. mask = 0x400;
  724. dev->irq = r->get(pirq_router_dev, dev, pirq);
  725. pci_write_config_byte(dev, PCI_INTERRUPT_LINE, dev->irq);
  726. }
  727. /*
  728. * Find the best IRQ to assign: use the one
  729. * reported by the device if possible.
  730. */
  731. newirq = dev->irq;
  732. if (!((1 << newirq) & mask)) {
  733. if ( pci_probe & PCI_USE_PIRQ_MASK) newirq = 0;
  734. else printk(KERN_WARNING "PCI: IRQ %i for device %s doesn't match PIRQ mask - try pci=usepirqmask\n", newirq, pci_name(dev));
  735. }
  736. if (!newirq && assign) {
  737. for (i = 0; i < 16; i++) {
  738. if (!(mask & (1 << i)))
  739. continue;
  740. if (pirq_penalty[i] < pirq_penalty[newirq] && can_request_irq(i, SA_SHIRQ))
  741. newirq = i;
  742. }
  743. }
  744. DBG(" -> newirq=%d", newirq);
  745. /* Check if it is hardcoded */
  746. if ((pirq & 0xf0) == 0xf0) {
  747. irq = pirq & 0xf;
  748. DBG(" -> hardcoded IRQ %d\n", irq);
  749. msg = "Hardcoded";
  750. } else if ( r->get && (irq = r->get(pirq_router_dev, dev, pirq)) && \
  751. ((!(pci_probe & PCI_USE_PIRQ_MASK)) || ((1 << irq) & mask)) ) {
  752. DBG(" -> got IRQ %d\n", irq);
  753. msg = "Found";
  754. } else if (newirq && r->set && (dev->class >> 8) != PCI_CLASS_DISPLAY_VGA) {
  755. DBG(" -> assigning IRQ %d", newirq);
  756. if (r->set(pirq_router_dev, dev, pirq, newirq)) {
  757. eisa_set_level_irq(newirq);
  758. DBG(" ... OK\n");
  759. msg = "Assigned";
  760. irq = newirq;
  761. }
  762. }
  763. if (!irq) {
  764. DBG(" ... failed\n");
  765. if (newirq && mask == (1 << newirq)) {
  766. msg = "Guessed";
  767. irq = newirq;
  768. } else
  769. return 0;
  770. }
  771. printk(KERN_INFO "PCI: %s IRQ %d for device %s\n", msg, irq, pci_name(dev));
  772. /* Update IRQ for all devices with the same pirq value */
  773. while ((dev2 = pci_get_device(PCI_ANY_ID, PCI_ANY_ID, dev2)) != NULL) {
  774. pci_read_config_byte(dev2, PCI_INTERRUPT_PIN, &pin);
  775. if (!pin)
  776. continue;
  777. pin--;
  778. info = pirq_get_info(dev2);
  779. if (!info)
  780. continue;
  781. if (info->irq[pin].link == pirq) {
  782. /* We refuse to override the dev->irq information. Give a warning! */
  783. if ( dev2->irq && dev2->irq != irq && \
  784. (!(pci_probe & PCI_USE_PIRQ_MASK) || \
  785. ((1 << dev2->irq) & mask)) ) {
  786. #ifndef CONFIG_PCI_MSI
  787. printk(KERN_INFO "IRQ routing conflict for %s, have irq %d, want irq %d\n",
  788. pci_name(dev2), dev2->irq, irq);
  789. #endif
  790. continue;
  791. }
  792. dev2->irq = irq;
  793. pirq_penalty[irq]++;
  794. if (dev != dev2)
  795. printk(KERN_INFO "PCI: Sharing IRQ %d with %s\n", irq, pci_name(dev2));
  796. }
  797. }
  798. return 1;
  799. }
  800. static void __init pcibios_fixup_irqs(void)
  801. {
  802. struct pci_dev *dev = NULL;
  803. u8 pin;
  804. DBG("PCI: IRQ fixup\n");
  805. while ((dev = pci_get_device(PCI_ANY_ID, PCI_ANY_ID, dev)) != NULL) {
  806. /*
  807. * If the BIOS has set an out of range IRQ number, just ignore it.
  808. * Also keep track of which IRQ's are already in use.
  809. */
  810. if (dev->irq >= 16) {
  811. DBG("%s: ignoring bogus IRQ %d\n", pci_name(dev), dev->irq);
  812. dev->irq = 0;
  813. }
  814. /* If the IRQ is already assigned to a PCI device, ignore its ISA use penalty */
  815. if (pirq_penalty[dev->irq] >= 100 && pirq_penalty[dev->irq] < 100000)
  816. pirq_penalty[dev->irq] = 0;
  817. pirq_penalty[dev->irq]++;
  818. }
  819. dev = NULL;
  820. while ((dev = pci_get_device(PCI_ANY_ID, PCI_ANY_ID, dev)) != NULL) {
  821. pci_read_config_byte(dev, PCI_INTERRUPT_PIN, &pin);
  822. #ifdef CONFIG_X86_IO_APIC
  823. /*
  824. * Recalculate IRQ numbers if we use the I/O APIC.
  825. */
  826. if (io_apic_assign_pci_irqs)
  827. {
  828. int irq;
  829. if (pin) {
  830. pin--; /* interrupt pins are numbered starting from 1 */
  831. irq = IO_APIC_get_PCI_irq_vector(dev->bus->number, PCI_SLOT(dev->devfn), pin);
  832. /*
  833. * Busses behind bridges are typically not listed in the MP-table.
  834. * In this case we have to look up the IRQ based on the parent bus,
  835. * parent slot, and pin number. The SMP code detects such bridged
  836. * busses itself so we should get into this branch reliably.
  837. */
  838. if (irq < 0 && dev->bus->parent) { /* go back to the bridge */
  839. struct pci_dev * bridge = dev->bus->self;
  840. pin = (pin + PCI_SLOT(dev->devfn)) % 4;
  841. irq = IO_APIC_get_PCI_irq_vector(bridge->bus->number,
  842. PCI_SLOT(bridge->devfn), pin);
  843. if (irq >= 0)
  844. printk(KERN_WARNING "PCI: using PPB %s[%c] to get irq %d\n",
  845. pci_name(bridge), 'A' + pin, irq);
  846. }
  847. if (irq >= 0) {
  848. if (use_pci_vector() &&
  849. !platform_legacy_irq(irq))
  850. irq = IO_APIC_VECTOR(irq);
  851. printk(KERN_INFO "PCI->APIC IRQ transform: %s[%c] -> IRQ %d\n",
  852. pci_name(dev), 'A' + pin, irq);
  853. dev->irq = irq;
  854. }
  855. }
  856. }
  857. #endif
  858. /*
  859. * Still no IRQ? Try to lookup one...
  860. */
  861. if (pin && !dev->irq)
  862. pcibios_lookup_irq(dev, 0);
  863. }
  864. }
  865. /*
  866. * Work around broken HP Pavilion Notebooks which assign USB to
  867. * IRQ 9 even though it is actually wired to IRQ 11
  868. */
  869. static int __init fix_broken_hp_bios_irq9(struct dmi_system_id *d)
  870. {
  871. if (!broken_hp_bios_irq9) {
  872. broken_hp_bios_irq9 = 1;
  873. printk(KERN_INFO "%s detected - fixing broken IRQ routing\n", d->ident);
  874. }
  875. return 0;
  876. }
  877. /*
  878. * Work around broken Acer TravelMate 360 Notebooks which assign
  879. * Cardbus to IRQ 11 even though it is actually wired to IRQ 10
  880. */
  881. static int __init fix_acer_tm360_irqrouting(struct dmi_system_id *d)
  882. {
  883. if (!acer_tm360_irqrouting) {
  884. acer_tm360_irqrouting = 1;
  885. printk(KERN_INFO "%s detected - fixing broken IRQ routing\n", d->ident);
  886. }
  887. return 0;
  888. }
  889. static struct dmi_system_id __initdata pciirq_dmi_table[] = {
  890. {
  891. .callback = fix_broken_hp_bios_irq9,
  892. .ident = "HP Pavilion N5400 Series Laptop",
  893. .matches = {
  894. DMI_MATCH(DMI_SYS_VENDOR, "Hewlett-Packard"),
  895. DMI_MATCH(DMI_BIOS_VERSION, "GE.M1.03"),
  896. DMI_MATCH(DMI_PRODUCT_VERSION, "HP Pavilion Notebook Model GE"),
  897. DMI_MATCH(DMI_BOARD_VERSION, "OmniBook N32N-736"),
  898. },
  899. },
  900. {
  901. .callback = fix_acer_tm360_irqrouting,
  902. .ident = "Acer TravelMate 36x Laptop",
  903. .matches = {
  904. DMI_MATCH(DMI_SYS_VENDOR, "Acer"),
  905. DMI_MATCH(DMI_PRODUCT_NAME, "TravelMate 360"),
  906. },
  907. },
  908. { }
  909. };
  910. static int __init pcibios_irq_init(void)
  911. {
  912. DBG("PCI: IRQ init\n");
  913. if (pcibios_enable_irq || raw_pci_ops == NULL)
  914. return 0;
  915. dmi_check_system(pciirq_dmi_table);
  916. pirq_table = pirq_find_routing_table();
  917. #ifdef CONFIG_PCI_BIOS
  918. if (!pirq_table && (pci_probe & PCI_BIOS_IRQ_SCAN))
  919. pirq_table = pcibios_get_irq_routing_table();
  920. #endif
  921. if (pirq_table) {
  922. pirq_peer_trick();
  923. pirq_find_router(&pirq_router);
  924. if (pirq_table->exclusive_irqs) {
  925. int i;
  926. for (i=0; i<16; i++)
  927. if (!(pirq_table->exclusive_irqs & (1 << i)))
  928. pirq_penalty[i] += 100;
  929. }
  930. /* If we're using the I/O APIC, avoid using the PCI IRQ routing table */
  931. if (io_apic_assign_pci_irqs)
  932. pirq_table = NULL;
  933. }
  934. pcibios_enable_irq = pirq_enable_irq;
  935. pcibios_fixup_irqs();
  936. return 0;
  937. }
  938. subsys_initcall(pcibios_irq_init);
  939. static void pirq_penalize_isa_irq(int irq, int active)
  940. {
  941. /*
  942. * If any ISAPnP device reports an IRQ in its list of possible
  943. * IRQ's, we try to avoid assigning it to PCI devices.
  944. */
  945. if (irq < 16) {
  946. if (active)
  947. pirq_penalty[irq] += 1000;
  948. else
  949. pirq_penalty[irq] += 100;
  950. }
  951. }
  952. void pcibios_penalize_isa_irq(int irq, int active)
  953. {
  954. #ifdef CONFIG_ACPI
  955. if (!acpi_noirq)
  956. acpi_penalize_isa_irq(irq, active);
  957. else
  958. #endif
  959. pirq_penalize_isa_irq(irq, active);
  960. }
  961. static int pirq_enable_irq(struct pci_dev *dev)
  962. {
  963. u8 pin;
  964. struct pci_dev *temp_dev;
  965. pci_read_config_byte(dev, PCI_INTERRUPT_PIN, &pin);
  966. if (pin && !pcibios_lookup_irq(dev, 1) && !dev->irq) {
  967. char *msg = "";
  968. pin--; /* interrupt pins are numbered starting from 1 */
  969. if (io_apic_assign_pci_irqs) {
  970. int irq;
  971. irq = IO_APIC_get_PCI_irq_vector(dev->bus->number, PCI_SLOT(dev->devfn), pin);
  972. /*
  973. * Busses behind bridges are typically not listed in the MP-table.
  974. * In this case we have to look up the IRQ based on the parent bus,
  975. * parent slot, and pin number. The SMP code detects such bridged
  976. * busses itself so we should get into this branch reliably.
  977. */
  978. temp_dev = dev;
  979. while (irq < 0 && dev->bus->parent) { /* go back to the bridge */
  980. struct pci_dev * bridge = dev->bus->self;
  981. pin = (pin + PCI_SLOT(dev->devfn)) % 4;
  982. irq = IO_APIC_get_PCI_irq_vector(bridge->bus->number,
  983. PCI_SLOT(bridge->devfn), pin);
  984. if (irq >= 0)
  985. printk(KERN_WARNING "PCI: using PPB %s[%c] to get irq %d\n",
  986. pci_name(bridge), 'A' + pin, irq);
  987. dev = bridge;
  988. }
  989. dev = temp_dev;
  990. if (irq >= 0) {
  991. #ifdef CONFIG_PCI_MSI
  992. if (!platform_legacy_irq(irq))
  993. irq = IO_APIC_VECTOR(irq);
  994. #endif
  995. printk(KERN_INFO "PCI->APIC IRQ transform: %s[%c] -> IRQ %d\n",
  996. pci_name(dev), 'A' + pin, irq);
  997. dev->irq = irq;
  998. return 0;
  999. } else
  1000. msg = " Probably buggy MP table.";
  1001. } else if (pci_probe & PCI_BIOS_IRQ_SCAN)
  1002. msg = "";
  1003. else
  1004. msg = " Please try using pci=biosirq.";
  1005. /* With IDE legacy devices the IRQ lookup failure is not a problem.. */
  1006. if (dev->class >> 8 == PCI_CLASS_STORAGE_IDE && !(dev->class & 0x5))
  1007. return 0;
  1008. printk(KERN_WARNING "PCI: No IRQ known for interrupt pin %c of device %s.%s\n",
  1009. 'A' + pin, pci_name(dev), msg);
  1010. }
  1011. return 0;
  1012. }
  1013. int pci_vector_resources(int last, int nr_released)
  1014. {
  1015. int count = nr_released;
  1016. int next = last;
  1017. int offset = (last % 8);
  1018. while (next < FIRST_SYSTEM_VECTOR) {
  1019. next += 8;
  1020. #ifdef CONFIG_X86_64
  1021. if (next == IA32_SYSCALL_VECTOR)
  1022. continue;
  1023. #else
  1024. if (next == SYSCALL_VECTOR)
  1025. continue;
  1026. #endif
  1027. count++;
  1028. if (next >= FIRST_SYSTEM_VECTOR) {
  1029. if (offset%8) {
  1030. next = FIRST_DEVICE_VECTOR + offset;
  1031. offset++;
  1032. continue;
  1033. }
  1034. count--;
  1035. }
  1036. }
  1037. return count;
  1038. }