37 lines
781 B
C
37 lines
781 B
C
|
// SPDX-License-Identifier: GPL-2.0+
|
||
|
|
/*
|
||
|
|
* Copyright (C) 2015, Bin Meng <bmeng.cn@gmail.com>
|
||
|
|
*/
|
||
|
|
|
||
|
|
#include <common.h>
|
||
|
|
#include <asm/io.h>
|
||
|
|
#include <asm/ioapic.h>
|
||
|
|
#include <asm/lapic.h>
|
||
|
|
|
||
|
|
u32 io_apic_read(u32 reg)
|
||
|
|
{
|
||
|
|
writel(reg, IO_APIC_INDEX);
|
||
|
|
return readl(IO_APIC_DATA);
|
||
|
|
}
|
||
|
|
|
||
|
|
void io_apic_write(u32 reg, u32 val)
|
||
|
|
{
|
||
|
|
writel(reg, IO_APIC_INDEX);
|
||
|
|
writel(val, IO_APIC_DATA);
|
||
|
|
}
|
||
|
|
|
||
|
|
void io_apic_set_id(int ioapic_id)
|
||
|
|
{
|
||
|
|
int bsp_lapicid = lapicid();
|
||
|
|
|
||
|
|
debug("IOAPIC: Initialising IOAPIC at %08x\n", IO_APIC_ADDR);
|
||
|
|
debug("IOAPIC: Bootstrap Processor Local APIC = %#02x\n", bsp_lapicid);
|
||
|
|
|
||
|
|
if (ioapic_id) {
|
||
|
|
debug("IOAPIC: ID = 0x%02x\n", ioapic_id);
|
||
|
|
/* Set IOAPIC ID if it has been specified */
|
||
|
|
io_apic_write(0x00, (io_apic_read(0x00) & 0xf0ffffff) |
|
||
|
|
(ioapic_id << 24));
|
||
|
|
}
|
||
|
|
}
|