arch/x86/cpu/ioapic.c

   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
  11 u32 io_apic_read(u32 reg)
  12 {
  13         writel(reg, IO_APIC_INDEX);
  14         return readl(IO_APIC_DATA);
  15 }
  16
  17 void io_apic_write(u32 reg, u32 val)
  18 {
  19         writel(reg, IO_APIC_INDEX);
  20         writel(val, IO_APIC_DATA);
  21 }
  22
  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 }