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