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