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