src/arch/x86/boot/pirq_routing.c

   1 #include <console/console.h>
   2 #include <arch/pirq_routing.h>
   3 #include <string.h>
   4 #include <device/pci.h>
   5
   6 #if CONFIG_DEBUG_PIRQ
   7 static void check_pirq_routing_table(struct irq_routing_table *rt)
   8 {
   9         uint8_t *addr = (uint8_t *)rt;
  10         uint8_t sum=0;
  11         int i;
  12
  13         printk(BIOS_INFO, "Checking Interrupt Routing Table consistency...\n");
  14
  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),
  18                                rt->size
  19                         );
  20                 rt->size=sizeof(struct irq_routing_table);
  21         }
  22
  23         for (i = 0; i < rt->size; i++)
  24                 sum += addr[i];
  25
  26         printk(BIOS_DEBUG, "%s(): Interrupt Routing Table located at %p.\n",
  27                      __func__, addr);
  28
  29
  30         sum = rt->checksum - sum;
  31
  32         if (sum != rt->checksum) {
  33                 printk(BIOS_WARNING, "Interrupt Routing Table checksum is: 0x%02x but should be: 0x%02x.\n",
  34                                rt->checksum, sum);
  35                 rt->checksum = sum;
  36         }
  37
  38         if (rt->signature != PIRQ_SIGNATURE || rt->version != PIRQ_VERSION ||
  39             rt->size % 16 ) {
  40                 printk(BIOS_WARNING, "Interrupt Routing Table not valid.\n");
  41                 return;
  42         }
  43
  44         sum = 0;
  45         for (i=0; i<rt->size; i++)
  46                 sum += addr[i];
  47
  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.
  51          */
  52         if (sum) {
  53                 printk(BIOS_WARNING, "Checksum error in Interrupt Routing Table "
  54                                 "could not be fixed.\n");
  55         }
  56
  57         printk(BIOS_INFO, "done.\n");
  58 }
  59
  60 static int verify_copy_pirq_routing_table(unsigned long addr)
  61 {
  62         int i;
  63         uint8_t *rt_orig, *rt_curr;
  64
  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");
  71                         return -1;
  72                 }
  73         }
  74         printk(BIOS_INFO, "done\n");
  75
  76         check_pirq_routing_table((struct irq_routing_table *)addr);
  77
  78         return 0;
  79 }
  80 #endif
  81
  82 unsigned long copy_pirq_routing_table(unsigned long addr)
  83 {
  84         /* Align the table to be 16 byte aligned. */
  85         addr += 15;
  86         addr &= ~15;
  87
  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");
  92 #if CONFIG_DEBUG_PIRQ
  93         verify_copy_pirq_routing_table(addr);
  94 #endif
  95         pirq_routing_irqs(addr);
  96         return addr + intel_irq_routing_table.size;
  97 }
  98
  99 #if CONFIG_PIRQ_ROUTE
 100 void pirq_routing_irqs(unsigned long addr)
 101 {
 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;
 106
 107         pirq_tbl = (struct irq_routing_table *)(addr);
 108         num_entries = (pirq_tbl->size - 32) / 16;
 109
 110         /* Set PCI IRQs. */
 111         for (i = 0; i < num_entries; i++) {
 112
 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);
 115
 116                 for (j = 0; j < 4; j++) {
 117
 118                         int link = pirq_tbl->slots[i].irq[j].link;
 119                         int bitmap = pirq_tbl->slots[i].irq[j].bitmap;
 120                         int irq = 0;
 121
 122                         printk(BIOS_DEBUG, "INT: %c link: %x bitmap: %x  ",
 123                                 'A' + j, link, bitmap);
 124
 125                         if (!bitmap|| !link || link > 4) {
 126
 127                                 printk(BIOS_DEBUG, "not routed\n");
 128                                 irq_slot[j] = irq;
 129                                 continue;
 130                         }
 131
 132                         /* yet not routed */
 133                         if (!pirq[link - 1]) {
 134
 135                                 for (k = 2; k <= 15; k++) {
 136
 137                                         if (!((bitmap >> k) & 1))
 138                                                 continue;
 139
 140                                         irq = k;
 141
 142                                         /* yet not routed */
 143                                         if (pirq[0] != irq && pirq[1] != irq && pirq[2] != irq && pirq[3] != irq)
 144                                                 break;
 145                                 }
 146
 147                                 if (irq)
 148                                         pirq[link - 1] = irq;
 149                         }
 150                         else
 151                                 irq = pirq[link - 1];
 152
 153                         printk(BIOS_DEBUG, "IRQ: %d\n", irq);
 154                         irq_slot[j] = irq;
 155                 }
 156
 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);
 160         }
 161
 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]);
 166
 167         pirq_assign_irqs(pirq);
 168 }
 169 #endif