src/arch/i386/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 #ifndef CONFIG_IRQ_SLOT_COUNT
   7 #warning "CONFIG_IRQ_SLOT_COUNT is not defined. PIRQ won't work correctly."
   8 #endif
   9
  10 #if CONFIG_DEBUG
  11 static void check_pirq_routing_table(struct irq_routing_table *rt)
  12 {
  13         uint8_t *addr = (uint8_t *)rt;
  14         uint8_t sum=0;
  15         int i;
  16
  17         printk_info("Checking Interrupt Routing Table consistency...\n");
  18
  19         if (sizeof(struct irq_routing_table) != rt->size) {
  20                 printk_warning("Inconsistent Interrupt Routing Table size (0x%x/0x%x).\n",
  21                                sizeof(struct irq_routing_table),
  22                                rt->size
  23                         );
  24                 rt->size=sizeof(struct irq_routing_table);
  25         }
  26
  27         for (i = 0; i < rt->size; i++)
  28                 sum += addr[i];
  29
  30         printk_debug("%s(): Interrupt Routing Table located at %p.\n",
  31                      __func__, addr);
  32
  33
  34         sum = rt->checksum - sum;
  35
  36         if (sum != rt->checksum) {
  37                 printk_warning("Interrupt Routing Table checksum is: 0x%02x but should be: 0x%02x.\n",
  38                                rt->checksum, sum);
  39                 rt->checksum = sum;
  40         }
  41
  42         if (rt->signature != PIRQ_SIGNATURE || rt->version != PIRQ_VERSION ||
  43             rt->size % 16 ) {
  44                 printk_warning("Interrupt Routing Table not valid.\n");
  45                 return;
  46         }
  47
  48         sum = 0;
  49         for (i=0; i<rt->size; i++)
  50                 sum += addr[i];
  51
  52         /* We're manually fixing the checksum above. This warning can probably
  53          * never happen because if the target location is read-only this
  54          * function would have bailed out earlier.
  55          */
  56         if (sum) {
  57                 printk_warning("Checksum error in Interrupt Routing Table "
  58                                 "could not be fixed.\n");
  59         }
  60
  61         printk_info("done.\n");
  62 }
  63
  64 static int verify_copy_pirq_routing_table(unsigned long addr)
  65 {
  66         int i;
  67         uint8_t *rt_orig, *rt_curr;
  68
  69         rt_curr = (uint8_t*)addr;
  70         rt_orig = (uint8_t*)&intel_irq_routing_table;
  71         printk_info("Verifing copy of Interrupt Routing Table at 0x%08x... ", addr);
  72         for (i = 0; i < intel_irq_routing_table.size; i++) {
  73                 if (*(rt_curr + i) != *(rt_orig + i)) {
  74                         printk_info("failed\n");
  75                         return -1;
  76                 }
  77         }
  78         printk_info("done\n");
  79
  80         check_pirq_routing_table((struct irq_routing_table *)addr);
  81
  82         return 0;
  83 }
  84 #endif
  85
  86 unsigned long copy_pirq_routing_table(unsigned long addr)
  87 {
  88         /* Align the table to be 16 byte aligned. */
  89         addr += 15;
  90         addr &= ~15;
  91
  92         /* This table must be betweeen 0xf0000 & 0x100000 */
  93         printk_info("Copying Interrupt Routing Table to 0x%08lx... ", addr);
  94         memcpy((void *)addr, &intel_irq_routing_table, intel_irq_routing_table.size);
  95         printk_info("done.\n");
  96 #if CONFIG_DEBUG
  97         verify_copy_pirq_routing_table(addr);
  98 #endif
  99         pirq_routing_irqs(addr);
 100         return addr + intel_irq_routing_table.size;
 101 }
 102
 103 #if CONFIG_PIRQ_ROUTE
 104 void pirq_routing_irqs(unsigned long addr)
 105 {
 106         int i, j, k, num_entries;
 107         unsigned char irq_slot[4];
 108         unsigned char pirq[4] = {0, 0, 0, 0};
 109         struct irq_routing_table *pirq_tbl;
 110
 111         pirq_tbl = (struct irq_routing_table *)(addr);
 112         num_entries = (pirq_tbl->size - 32) / 16;
 113
 114         /* Set PCI IRQs. */
 115         for (i = 0; i < num_entries; i++) {
 116
 117                 printk_debug("PIRQ Entry %d Dev/Fn: %X Slot: %d\n", i,
 118                         pirq_tbl->slots[i].devfn >> 3, pirq_tbl->slots[i].slot);
 119
 120                 for (j = 0; j < 4; j++) {
 121
 122                         int link = pirq_tbl->slots[i].irq[j].link;
 123                         int bitmap = pirq_tbl->slots[i].irq[j].bitmap;
 124                         int irq = 0;
 125
 126                         printk_debug("INT: %c link: %x bitmap: %x  ",
 127                                 'A' + j, link, bitmap);
 128
 129                         if (!bitmap|| !link || link > 4) {
 130
 131                                 printk_debug("not routed\n");
 132                                 irq_slot[j] = irq;
 133                                 continue;
 134                         }
 135
 136                         /* yet not routed */
 137                         if (!pirq[link - 1]) {
 138
 139                                 for (k = 2; k <= 15; k++) {
 140
 141                                         if (!((bitmap >> k) & 1))
 142                                                 continue;
 143
 144                                         irq = k;
 145
 146                                         /* yet not routed */
 147                                         if (pirq[0] != irq && pirq[1] != irq && pirq[2] != irq && pirq[3] != irq)
 148                                                 break;
 149                                 }
 150
 151                                 if (irq)
 152                                         pirq[link - 1] = irq;
 153                         }
 154                         else
 155                                 irq = pirq[link - 1];
 156
 157                         printk_debug("IRQ: %d\n", irq);
 158                         irq_slot[j] = irq;
 159                 }
 160
 161                 /* Bus, device, slots IRQs for {A,B,C,D}. */
 162                 pci_assign_irqs(pirq_tbl->slots[i].bus,
 163                         pirq_tbl->slots[i].devfn >> 3, irq_slot);
 164         }
 165
 166         printk_debug("PIRQ1: %d\n", pirq[0]);
 167         printk_debug("PIRQ2: %d\n", pirq[1]);
 168         printk_debug("PIRQ3: %d\n", pirq[2]);
 169         printk_debug("PIRQ4: %d\n", pirq[3]);
 170
 171         pirq_assign_irqs(pirq);
 172 }
 173 #endif