1 #include <console/console.h>
2 #include <arch/pirq_routing.h>
4 #include <device/pci.h>
7 static void check_pirq_routing_table(struct irq_routing_table *rt)
9 uint8_t *addr = (uint8_t *)rt;
13 printk(BIOS_INFO, "Checking Interrupt Routing Table consistency...\n");
15 if (sizeof(struct irq_routing_table) != rt->size) {
16 printk(BIOS_WARNING, "Inconsistent Interrupt Routing Table size (0x%x/0x%x).\n",
17 (unsigned int) sizeof(struct irq_routing_table),
20 rt->size=sizeof(struct irq_routing_table);
23 for (i = 0; i < rt->size; i++)
26 printk(BIOS_DEBUG, "%s(): Interrupt Routing Table located at %p.\n",
30 sum = rt->checksum - sum;
32 if (sum != rt->checksum) {
33 printk(BIOS_WARNING, "Interrupt Routing Table checksum is: 0x%02x but should be: 0x%02x.\n",
38 if (rt->signature != PIRQ_SIGNATURE || rt->version != PIRQ_VERSION ||
40 printk(BIOS_WARNING, "Interrupt Routing Table not valid.\n");
45 for (i=0; i<rt->size; i++)
48 /* We're manually fixing the checksum above. This warning can probably
49 * never happen because if the target location is read-only this
50 * function would have bailed out earlier.
53 printk(BIOS_WARNING, "Checksum error in Interrupt Routing Table "
54 "could not be fixed.\n");
57 printk(BIOS_INFO, "done.\n");
60 static int verify_copy_pirq_routing_table(unsigned long addr)
63 uint8_t *rt_orig, *rt_curr;
65 rt_curr = (uint8_t*)addr;
66 rt_orig = (uint8_t*)&intel_irq_routing_table;
67 printk(BIOS_INFO, "Verifying copy of Interrupt Routing Table at 0x%08lx... ", addr);
68 for (i = 0; i < intel_irq_routing_table.size; i++) {
69 if (*(rt_curr + i) != *(rt_orig + i)) {
70 printk(BIOS_INFO, "failed\n");
74 printk(BIOS_INFO, "done\n");
76 check_pirq_routing_table((struct irq_routing_table *)addr);
82 unsigned long copy_pirq_routing_table(unsigned long addr)
84 /* Align the table to be 16 byte aligned. */
88 /* This table must be betweeen 0xf0000 & 0x100000 */
89 printk(BIOS_INFO, "Copying Interrupt Routing Table to 0x%08lx... ", addr);
90 memcpy((void *)addr, &intel_irq_routing_table, intel_irq_routing_table.size);
91 printk(BIOS_INFO, "done.\n");
93 verify_copy_pirq_routing_table(addr);
95 pirq_routing_irqs(addr);
96 return addr + intel_irq_routing_table.size;
100 void pirq_routing_irqs(unsigned long addr)
102 int i, j, k, num_entries;
103 unsigned char irq_slot[4];
104 unsigned char pirq[4] = {0, 0, 0, 0};
105 struct irq_routing_table *pirq_tbl;
107 pirq_tbl = (struct irq_routing_table *)(addr);
108 num_entries = (pirq_tbl->size - 32) / 16;
111 for (i = 0; i < num_entries; i++) {
113 printk(BIOS_DEBUG, "PIRQ Entry %d Dev/Fn: %X Slot: %d\n", i,
114 pirq_tbl->slots[i].devfn >> 3, pirq_tbl->slots[i].slot);
116 for (j = 0; j < 4; j++) {
118 int link = pirq_tbl->slots[i].irq[j].link;
119 int bitmap = pirq_tbl->slots[i].irq[j].bitmap;
122 printk(BIOS_DEBUG, "INT: %c link: %x bitmap: %x ",
123 'A' + j, link, bitmap);
125 if (!bitmap|| !link || link > 4) {
127 printk(BIOS_DEBUG, "not routed\n");
133 if (!pirq[link - 1]) {
135 for (k = 2; k <= 15; k++) {
137 if (!((bitmap >> k) & 1))
143 if (pirq[0] != irq && pirq[1] != irq && pirq[2] != irq && pirq[3] != irq)
148 pirq[link - 1] = irq;
151 irq = pirq[link - 1];
153 printk(BIOS_DEBUG, "IRQ: %d\n", irq);
157 /* Bus, device, slots IRQs for {A,B,C,D}. */
158 pci_assign_irqs(pirq_tbl->slots[i].bus,
159 pirq_tbl->slots[i].devfn >> 3, irq_slot);
162 printk(BIOS_DEBUG, "PIRQ1: %d\n", pirq[0]);
163 printk(BIOS_DEBUG, "PIRQ2: %d\n", pirq[1]);
164 printk(BIOS_DEBUG, "PIRQ3: %d\n", pirq[2]);
165 printk(BIOS_DEBUG, "PIRQ4: %d\n", pirq[3]);
167 pirq_assign_irqs(pirq);