1*4882a593Smuzhiyun /*
2*4882a593Smuzhiyun * Copyright (C) 2015, Bin Meng <bmeng.cn@gmail.com>
3*4882a593Smuzhiyun *
4*4882a593Smuzhiyun * SPDX-License-Identifier: GPL-2.0+
5*4882a593Smuzhiyun */
6*4882a593Smuzhiyun
7*4882a593Smuzhiyun #include <common.h>
8*4882a593Smuzhiyun #include <asm/io.h>
9*4882a593Smuzhiyun #include <asm/ioapic.h>
10*4882a593Smuzhiyun #include <asm/lapic.h>
11*4882a593Smuzhiyun
io_apic_read(u32 reg)12*4882a593Smuzhiyun u32 io_apic_read(u32 reg)
13*4882a593Smuzhiyun {
14*4882a593Smuzhiyun writel(reg, IO_APIC_INDEX);
15*4882a593Smuzhiyun return readl(IO_APIC_DATA);
16*4882a593Smuzhiyun }
17*4882a593Smuzhiyun
io_apic_write(u32 reg,u32 val)18*4882a593Smuzhiyun void io_apic_write(u32 reg, u32 val)
19*4882a593Smuzhiyun {
20*4882a593Smuzhiyun writel(reg, IO_APIC_INDEX);
21*4882a593Smuzhiyun writel(val, IO_APIC_DATA);
22*4882a593Smuzhiyun }
23*4882a593Smuzhiyun
io_apic_set_id(int ioapic_id)24*4882a593Smuzhiyun void io_apic_set_id(int ioapic_id)
25*4882a593Smuzhiyun {
26*4882a593Smuzhiyun int bsp_lapicid = lapicid();
27*4882a593Smuzhiyun
28*4882a593Smuzhiyun debug("IOAPIC: Initialising IOAPIC at %08x\n", IO_APIC_ADDR);
29*4882a593Smuzhiyun debug("IOAPIC: Bootstrap Processor Local APIC = %#02x\n", bsp_lapicid);
30*4882a593Smuzhiyun
31*4882a593Smuzhiyun if (ioapic_id) {
32*4882a593Smuzhiyun debug("IOAPIC: ID = 0x%02x\n", ioapic_id);
33*4882a593Smuzhiyun /* Set IOAPIC ID if it has been specified */
34*4882a593Smuzhiyun io_apic_write(0x00, (io_apic_read(0x00) & 0xf0ffffff) |
35*4882a593Smuzhiyun (ioapic_id << 24));
36*4882a593Smuzhiyun }
37*4882a593Smuzhiyun }
38