283a08e52a
Previously the PIRQ routing table sanity check was performed against the original table provided by the platform codes. Now we switch to check its sanity on the final table in the F segment as this one is the one seen by the OS. Signed-off-by: Bin Meng <bmeng.cn@gmail.com> Acked-by: Simon Glass <sjg@chromium.org>
138 lines
3.1 KiB
C
138 lines
3.1 KiB
C
/*
|
|
* Copyright (C) 2015, Bin Meng <bmeng.cn@gmail.com>
|
|
*
|
|
* Part of this file is ported from coreboot src/arch/x86/boot/pirq_routing.c
|
|
*
|
|
* SPDX-License-Identifier: GPL-2.0+
|
|
*/
|
|
|
|
#include <common.h>
|
|
#include <pci.h>
|
|
#include <asm/pci.h>
|
|
#include <asm/pirq_routing.h>
|
|
#include <asm/tables.h>
|
|
|
|
static bool irq_already_routed[16];
|
|
|
|
static u8 pirq_get_next_free_irq(u8 *pirq, u16 bitmap)
|
|
{
|
|
int i, link;
|
|
u8 irq = 0;
|
|
|
|
/* IRQ sharing starts from IRQ#3 */
|
|
for (i = 3; i < 16; i++) {
|
|
/* Can we assign this IRQ? */
|
|
if (!((bitmap >> i) & 1))
|
|
continue;
|
|
|
|
/* We can, now let's assume we can use this IRQ */
|
|
irq = i;
|
|
|
|
/* Have we already routed it? */
|
|
if (irq_already_routed[irq])
|
|
continue;
|
|
|
|
for (link = 0; link < CONFIG_MAX_PIRQ_LINKS; link++) {
|
|
if (pirq_check_irq_routed(link, irq)) {
|
|
irq_already_routed[irq] = true;
|
|
break;
|
|
}
|
|
}
|
|
|
|
/* If it's not yet routed, use it */
|
|
if (!irq_already_routed[irq]) {
|
|
irq_already_routed[irq] = true;
|
|
break;
|
|
}
|
|
|
|
/* But if it was already routed, try the next one */
|
|
}
|
|
|
|
/* Now we get our IRQ */
|
|
return irq;
|
|
}
|
|
|
|
void pirq_route_irqs(struct irq_info *irq, int num)
|
|
{
|
|
unsigned char irq_slot[MAX_INTX_ENTRIES];
|
|
unsigned char pirq[CONFIG_MAX_PIRQ_LINKS];
|
|
int i, intx;
|
|
|
|
memset(pirq, 0, CONFIG_MAX_PIRQ_LINKS);
|
|
|
|
/* Set PCI IRQs */
|
|
for (i = 0; i < num; i++) {
|
|
debug("PIRQ Entry %d Dev: %d.%x.%d\n", i,
|
|
irq->bus, irq->devfn >> 3, irq->devfn & 7);
|
|
|
|
for (intx = 0; intx < MAX_INTX_ENTRIES; intx++) {
|
|
int link = irq->irq[intx].link;
|
|
int bitmap = irq->irq[intx].bitmap;
|
|
int irq = 0;
|
|
|
|
debug("INT%c link: %x bitmap: %x ",
|
|
'A' + intx, link, bitmap);
|
|
|
|
if (!bitmap || !link) {
|
|
debug("not routed\n");
|
|
irq_slot[intx] = irq;
|
|
continue;
|
|
}
|
|
|
|
/* translate link value to link number */
|
|
link = pirq_translate_link(link);
|
|
|
|
/* yet not routed */
|
|
if (!pirq[link]) {
|
|
irq = pirq_get_next_free_irq(pirq, bitmap);
|
|
pirq[link] = irq;
|
|
} else {
|
|
irq = pirq[link];
|
|
}
|
|
|
|
debug("IRQ: %d\n", irq);
|
|
irq_slot[intx] = irq;
|
|
|
|
/* Assign IRQ in the interrupt router */
|
|
pirq_assign_irq(link, irq);
|
|
}
|
|
|
|
/* Bus, device, slots IRQs for {A,B,C,D} */
|
|
pci_assign_irqs(irq->bus, irq->devfn >> 3, irq->devfn & 7,
|
|
irq_slot);
|
|
|
|
irq++;
|
|
}
|
|
|
|
for (i = 0; i < CONFIG_MAX_PIRQ_LINKS; i++)
|
|
debug("PIRQ%c: %d\n", 'A' + i, pirq[i]);
|
|
}
|
|
|
|
u32 copy_pirq_routing_table(u32 addr, struct irq_routing_table *rt)
|
|
{
|
|
struct irq_routing_table *rom_rt;
|
|
|
|
/* Fix up the table checksum */
|
|
rt->checksum = table_compute_checksum(rt, rt->size);
|
|
|
|
/* Align the table to be 16 byte aligned */
|
|
addr = ALIGN(addr, 16);
|
|
|
|
debug("Copying Interrupt Routing Table to 0x%x\n", addr);
|
|
memcpy((void *)addr, rt, rt->size);
|
|
|
|
/*
|
|
* We do the sanity check here against the copied table after memcpy,
|
|
* as something might go wrong after the memcpy, which is normally
|
|
* due to the F segment decode is not turned on to systeam RAM.
|
|
*/
|
|
rom_rt = (struct irq_routing_table *)addr;
|
|
if (rom_rt->signature != PIRQ_SIGNATURE ||
|
|
rom_rt->version != PIRQ_VERSION || rom_rt->size % 16) {
|
|
printf("Interrupt Routing Table not valid\n");
|
|
return addr;
|
|
}
|
|
|
|
return addr + rt->size;
|
|
}
|