LXR uboot/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 <log.h>
   8#include <asm/io.h>
   9#include <asm/ioapic.h>
  10#include <asm/lapic.h>
  11
  12u32 io_apic_read(u32 reg)
  13{
  14        writel(reg, IO_APIC_INDEX);
  15        return readl(IO_APIC_DATA);
  16}
  17
  18void io_apic_write(u32 reg, u32 val)
  19{
  20        writel(reg, IO_APIC_INDEX);
  21        writel(val, IO_APIC_DATA);
  22}
  23
  24void 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