13d232878SBin Meng /*
23d232878SBin Meng * Copyright (C) 2015, Bin Meng <bmeng.cn@gmail.com>
33d232878SBin Meng *
43d232878SBin Meng * SPDX-License-Identifier: GPL-2.0+
53d232878SBin Meng */
63d232878SBin Meng
73d232878SBin Meng #include <common.h>
83d232878SBin Meng #include <asm/io.h>
93d232878SBin Meng #include <asm/ioapic.h>
10*1cb1611fSSimon Glass #include <asm/lapic.h>
113d232878SBin Meng
io_apic_read(u32 reg)123d232878SBin Meng u32 io_apic_read(u32 reg)
133d232878SBin Meng {
143d232878SBin Meng writel(reg, IO_APIC_INDEX);
153d232878SBin Meng return readl(IO_APIC_DATA);
163d232878SBin Meng }
173d232878SBin Meng
io_apic_write(u32 reg,u32 val)183d232878SBin Meng void io_apic_write(u32 reg, u32 val)
193d232878SBin Meng {
203d232878SBin Meng writel(reg, IO_APIC_INDEX);
213d232878SBin Meng writel(val, IO_APIC_DATA);
223d232878SBin Meng }
23*1cb1611fSSimon Glass
io_apic_set_id(int ioapic_id)24*1cb1611fSSimon Glass void io_apic_set_id(int ioapic_id)
25*1cb1611fSSimon Glass {
26*1cb1611fSSimon Glass int bsp_lapicid = lapicid();
27*1cb1611fSSimon Glass
28*1cb1611fSSimon Glass debug("IOAPIC: Initialising IOAPIC at %08x\n", IO_APIC_ADDR);
29*1cb1611fSSimon Glass debug("IOAPIC: Bootstrap Processor Local APIC = %#02x\n", bsp_lapicid);
30*1cb1611fSSimon Glass
31*1cb1611fSSimon Glass if (ioapic_id) {
32*1cb1611fSSimon Glass debug("IOAPIC: ID = 0x%02x\n", ioapic_id);
33*1cb1611fSSimon Glass /* Set IOAPIC ID if it has been specified */
34*1cb1611fSSimon Glass io_apic_write(0x00, (io_apic_read(0x00) & 0xf0ffffff) |
35*1cb1611fSSimon Glass (ioapic_id << 24));
36*1cb1611fSSimon Glass }
37*1cb1611fSSimon Glass }
38