src/arch/i386/boot/pirq_routing.c

   1 #include <console/console.h>
   2 #include <arch/pirq_routing.h>
   3 #include <string.h>
   4
   5 #ifdef DEBUG
   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\n");
  18         }
  19 #endif
  20
  21         rt = &intel_irq_routing_table;
  22         addr = (uint8_t *)rt;
  23
  24         sum = 0;
  25         for (i = 0; i < rt->size; i++)
  26                 sum += addr[i];
  27
  28         printk_debug("%s:%6d:%s() - irq_routing_table located at: 0x%p\n",
  29             __FILE__, __LINE__, __FUNCTION__, addr);
  30
  31         sum = (unsigned char)(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         }
  38
  39         if (rt->signature != PIRQ_SIGNATURE || rt->version != PIRQ_VERSION ||
  40             rt->size % 16 || rt->size < sizeof(struct irq_routing_table)) {
  41                 printk_warning("%s:%6d:%s() - "
  42                        "Interrupt Routing Table not valid\n",
  43                        __FILE__, __LINE__, __FUNCTION__);
  44                 return;
  45         }
  46
  47         sum = 0;
  48         for (i=0; i<rt->size; i++)
  49                 sum += addr[i];
  50
  51         if (sum) {
  52                 printk_warning("%s:%6d:%s() - "
  53                        "checksum error in irq routing table\n",
  54                        __FILE__, __LINE__, __FUNCTION__);
  55         }
  56
  57         printk_info("done.\n");
  58 }
  59
  60 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_info("Verifing priq routing tables copy at 0x%x...", addr);
  68         for (i = 0; i < intel_irq_routing_table.size; i++) {
  69                 if (*(rt_curr + i) != *(rt_orig + i)) {
  70                         printk_info("failed\n");
  71                         return -1;
  72                 }
  73         }
  74         printk_info("succeed\n");
  75         return 0;
  76 }
  77 #else
  78 #define verify_copy_pirq_routing_table(addr)
  79 #endif
  80
  81 unsigned long copy_pirq_routing_table(unsigned long addr)
  82 {
  83         /* Align the table to be 16 byte aligned. */
  84         addr += 15;
  85         addr &= ~15;
  86
  87         /* This table must be betweeen 0xf0000 & 0x100000 */
  88         printk_info("Copying IRQ routing tables to 0x%x...", addr);
  89         memcpy((void *)addr, &intel_irq_routing_table, intel_irq_routing_table.size);
  90         printk_info("done.\n");
  91         verify_copy_pirq_routing_table(addr);
  92         return addr + intel_irq_routing_table.size;
  93 }