src/arch/i386/boot/pirq_routing.c

   1 #include <console/console.h>
   2 #include <arch/pirq_routing.h>
   3 #include <string.h>
   4
   5 #if (DEBUG==1 && HAVE_PIRQ_TABLE==1)
   6 static void check_pirq_routing_table(struct irq_routing_table *rt)
   7 {
   8         uint8_t *addr = (uint8_t *)rt;
   9         uint8_t sum=0;
  10         int i;
  11
  12         printk_info("Checking IRQ routing table consistency...\n");
  13
  14 #if defined(IRQ_SLOT_COUNT)
  15         if (sizeof(struct irq_routing_table) != rt->size) {
  16                 printk_warning("Inconsistent IRQ routing table size (0x%x/0x%x)\n",
  17                                sizeof(struct irq_routing_table),
  18                                rt->size
  19                         );
  20                 rt->size=sizeof(struct irq_routing_table);
  21         }
  22 #endif
  23
  24         for (i = 0; i < rt->size; i++)
  25                 sum += addr[i];
  26
  27         printk_debug("%s:%6d:%s() - irq_routing_table located at: 0x%p\n",
  28                      __FILE__, __LINE__, __FUNCTION__, addr);
  29
  30
  31         sum = rt->checksum - sum;
  32
  33         if (sum != rt->checksum) {
  34                 printk_warning("%s:%6d:%s() - "
  35                                "checksum is: 0x%02x but should be: 0x%02x\n",
  36                                __FILE__, __LINE__, __FUNCTION__, rt->checksum, sum);
  37                 rt->checksum = sum;
  38         }
  39
  40         if (rt->signature != PIRQ_SIGNATURE || rt->version != PIRQ_VERSION ||
  41             rt->size % 16 ) {
  42                 printk_warning("%s:%6d:%s() - "
  43                                "Interrupt Routing Table not valid\n",
  44                                __FILE__, __LINE__, __FUNCTION__);
  45                 return;
  46         }
  47
  48         sum = 0;
  49         for (i=0; i<rt->size; i++)
  50                 sum += addr[i];
  51
  52         if (sum) {
  53                 printk_warning("%s:%6d:%s() - "
  54                                "checksum error in irq routing table\n",
  55                                __FILE__, __LINE__, __FUNCTION__);
  56         }
  57
  58         printk_info("done.\n");
  59 }
  60
  61 static int verify_copy_pirq_routing_table(unsigned long addr)
  62 {
  63         int i;
  64         uint8_t *rt_orig, *rt_curr;
  65
  66         rt_curr = (uint8_t*)addr;
  67         rt_orig = (uint8_t*)&intel_irq_routing_table;
  68         printk_info("Verifing copy of IRQ routing tables at 0x%x...", addr);
  69         for (i = 0; i < intel_irq_routing_table.size; i++) {
  70                 if (*(rt_curr + i) != *(rt_orig + i)) {
  71                         printk_info("failed\n");
  72                         return -1;
  73                 }
  74         }
  75         printk_info("done\n");
  76
  77         check_pirq_routing_table((struct irq_routing_table *)addr);
  78
  79         return 0;
  80 }
  81 #else
  82 #define verify_copy_pirq_routing_table(addr)
  83 #endif
  84
  85 #if HAVE_PIRQ_TABLE==1
  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 IRQ routing tables to 0x%x...", addr);
  94         memcpy((void *)addr, &intel_irq_routing_table, intel_irq_routing_table.size);
  95         printk_info("done.\n");
  96         verify_copy_pirq_routing_table(addr);
  97         return addr + intel_irq_routing_table.size;
  98 }
  99 #endif