x86: fsp: Allow remembering the location of FSP-S

[oweals/u-boot.git] / arch / x86 / cpu / ioapic.c

diff --git a/arch/x86/cpu/ioapic.c b/arch/x86/cpu/ioapic.c
index 112a9c63b449233ce67ad3358704c4092d38514d..01ade76a5868bc4dce7752c9a68a5a9de63a7702 100644 (file)
--- a/arch/x86/cpu/ioapic.c
+++ b/arch/x86/cpu/ioapic.c
@@ -1,12 +1,12 @@
+// SPDX-License-Identifier: GPL-2.0+
 /*
  * Copyright (C) 2015, Bin Meng <bmeng.cn@gmail.com>
- *
- * SPDX-License-Identifier:    GPL-2.0+
  */
 
 #include <common.h>
 #include <asm/io.h>
 #include <asm/ioapic.h>
+#include <asm/lapic.h>
 
 u32 io_apic_read(u32 reg)
 {
@@ -19,3 +19,18 @@ 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));
+       }
+}