2003-04-22 21:02:15 +02:00
|
|
|
#include <console/console.h>
|
|
|
|
#include <arch/pirq_routing.h>
|
|
|
|
#include <string.h>
|
|
|
|
|
2003-07-30 05:05:20 +02:00
|
|
|
#if DEBUG==1
|
2003-04-22 21:02:15 +02:00
|
|
|
void check_pirq_routing_table(void)
|
|
|
|
{
|
2003-04-24 08:56:37 +02:00
|
|
|
const uint8_t *addr;
|
2003-04-22 21:02:15 +02:00
|
|
|
const struct irq_routing_table *rt;
|
|
|
|
int i;
|
2003-04-24 08:56:37 +02:00
|
|
|
uint8_t sum;
|
2003-04-22 21:02:15 +02:00
|
|
|
|
|
|
|
printk_info("Checking IRQ routing tables...\n");
|
|
|
|
|
2003-04-24 08:56:37 +02:00
|
|
|
#if defined(IRQ_SLOT_COUNT)
|
2003-04-22 21:02:15 +02:00
|
|
|
if (sizeof(intel_irq_routing_table) != intel_irq_routing_table.size) {
|
2003-10-28 18:02:10 +01:00
|
|
|
printk_warning("Inconsistent IRQ routing table size (0x%x/0x%x)\n",
|
|
|
|
sizeof(intel_irq_routing_table),
|
|
|
|
intel_irq_routing_table.size
|
|
|
|
);
|
|
|
|
intel_irq_routing_table.size=sizeof(intel_irq_routing_table);
|
2003-04-22 21:02:15 +02:00
|
|
|
}
|
|
|
|
#endif
|
|
|
|
|
|
|
|
rt = &intel_irq_routing_table;
|
2003-04-24 08:56:37 +02:00
|
|
|
addr = (uint8_t *)rt;
|
2003-04-22 21:02:15 +02:00
|
|
|
|
|
|
|
sum = 0;
|
|
|
|
for (i = 0; i < rt->size; i++)
|
|
|
|
sum += addr[i];
|
|
|
|
|
|
|
|
printk_debug("%s:%6d:%s() - irq_routing_table located at: 0x%p\n",
|
|
|
|
__FILE__, __LINE__, __FUNCTION__, addr);
|
|
|
|
|
2003-04-25 04:02:25 +02:00
|
|
|
|
|
|
|
sum = rt->checksum - sum;
|
2003-04-22 21:02:15 +02:00
|
|
|
|
|
|
|
if (sum != rt->checksum) {
|
|
|
|
printk_warning("%s:%6d:%s() - "
|
|
|
|
"checksum is: 0x%02x but should be: 0x%02x\n",
|
|
|
|
__FILE__, __LINE__, __FUNCTION__, rt->checksum, sum);
|
2003-10-28 18:02:10 +01:00
|
|
|
rt->checksum = sum;
|
2003-04-22 21:02:15 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
if (rt->signature != PIRQ_SIGNATURE || rt->version != PIRQ_VERSION ||
|
|
|
|
rt->size % 16 || rt->size < sizeof(struct irq_routing_table)) {
|
|
|
|
printk_warning("%s:%6d:%s() - "
|
|
|
|
"Interrupt Routing Table not valid\n",
|
|
|
|
__FILE__, __LINE__, __FUNCTION__);
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
|
|
|
|
sum = 0;
|
|
|
|
for (i=0; i<rt->size; i++)
|
|
|
|
sum += addr[i];
|
|
|
|
|
|
|
|
if (sum) {
|
|
|
|
printk_warning("%s:%6d:%s() - "
|
|
|
|
"checksum error in irq routing table\n",
|
|
|
|
__FILE__, __LINE__, __FUNCTION__);
|
|
|
|
}
|
|
|
|
|
|
|
|
printk_info("done.\n");
|
|
|
|
}
|
|
|
|
|
|
|
|
int verify_copy_pirq_routing_table(unsigned long addr)
|
|
|
|
{
|
|
|
|
int i;
|
2003-04-24 08:56:37 +02:00
|
|
|
uint8_t *rt_orig, *rt_curr;
|
2003-04-22 21:02:15 +02:00
|
|
|
|
2003-04-24 08:56:37 +02:00
|
|
|
rt_curr = (uint8_t*)addr;
|
|
|
|
rt_orig = (uint8_t*)&intel_irq_routing_table;
|
2004-01-26 11:54:44 +01:00
|
|
|
printk_info("Verifing copy of IRQ routing tables at 0x%x...", addr);
|
2003-04-22 21:02:15 +02:00
|
|
|
for (i = 0; i < intel_irq_routing_table.size; i++) {
|
|
|
|
if (*(rt_curr + i) != *(rt_orig + i)) {
|
|
|
|
printk_info("failed\n");
|
|
|
|
return -1;
|
|
|
|
}
|
|
|
|
}
|
2004-01-26 11:54:44 +01:00
|
|
|
printk_info("done\n");
|
2003-04-22 21:02:15 +02:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
#else
|
|
|
|
#define verify_copy_pirq_routing_table(addr)
|
|
|
|
#endif
|
|
|
|
|
|
|
|
unsigned long copy_pirq_routing_table(unsigned long addr)
|
|
|
|
{
|
|
|
|
/* Align the table to be 16 byte aligned. */
|
|
|
|
addr += 15;
|
|
|
|
addr &= ~15;
|
|
|
|
|
|
|
|
/* This table must be betweeen 0xf0000 & 0x100000 */
|
|
|
|
printk_info("Copying IRQ routing tables to 0x%x...", addr);
|
|
|
|
memcpy((void *)addr, &intel_irq_routing_table, intel_irq_routing_table.size);
|
|
|
|
printk_info("done.\n");
|
|
|
|
verify_copy_pirq_routing_table(addr);
|
|
|
|
return addr + intel_irq_routing_table.size;
|
|
|
|
}
|