Patrick Georgi | 11f0079 | 2020-03-04 15:10:45 +0100 | [diff] [blame] | 1 | /* SPDX-License-Identifier: GPL-2.0-only */ |
Eric Biederman | 5899fd8 | 2003-04-24 06:25:08 +0000 | [diff] [blame] | 2 | |
Kyösti Mälkki | 13f6650 | 2019-03-03 08:01:05 +0200 | [diff] [blame] | 3 | #include <device/mmio.h> |
Stefan Reinauer | 0401bd8 | 2010-01-16 18:31:34 +0000 | [diff] [blame] | 4 | #include <arch/ioapic.h> |
| 5 | #include <console/console.h> |
| 6 | #include <cpu/x86/lapic.h> |
| 7 | |
Kevin Paul Herbert | bde6d30 | 2014-12-24 18:43:20 -0800 | [diff] [blame] | 8 | u32 io_apic_read(void *ioapic_base, u32 reg) |
Eric Biederman | 5899fd8 | 2003-04-24 06:25:08 +0000 | [diff] [blame] | 9 | { |
Stefan Reinauer | 0401bd8 | 2010-01-16 18:31:34 +0000 | [diff] [blame] | 10 | write32(ioapic_base, reg); |
| 11 | return read32(ioapic_base + 0x10); |
| 12 | } |
Eric Biederman | 5899fd8 | 2003-04-24 06:25:08 +0000 | [diff] [blame] | 13 | |
Kevin Paul Herbert | bde6d30 | 2014-12-24 18:43:20 -0800 | [diff] [blame] | 14 | void io_apic_write(void *ioapic_base, u32 reg, u32 value) |
Stefan Reinauer | 0401bd8 | 2010-01-16 18:31:34 +0000 | [diff] [blame] | 15 | { |
| 16 | write32(ioapic_base, reg); |
| 17 | write32(ioapic_base + 0x10, value); |
| 18 | } |
| 19 | |
Kevin Paul Herbert | bde6d30 | 2014-12-24 18:43:20 -0800 | [diff] [blame] | 20 | static int ioapic_interrupt_count(void *ioapic_base) |
Patrick Georgi | d1de45e | 2013-01-23 13:45:23 +0100 | [diff] [blame] | 21 | { |
| 22 | /* Read the available number of interrupts. */ |
| 23 | int ioapic_interrupts = (io_apic_read(ioapic_base, 0x01) >> 16) & 0xff; |
| 24 | if (ioapic_interrupts == 0xff) |
| 25 | ioapic_interrupts = 23; |
| 26 | ioapic_interrupts += 1; /* Bits 23-16 specify the maximum redirection |
| 27 | entry, which is the number of interrupts |
| 28 | minus 1. */ |
| 29 | printk(BIOS_DEBUG, "IOAPIC: %d interrupts\n", ioapic_interrupts); |
| 30 | |
| 31 | return ioapic_interrupts; |
| 32 | } |
| 33 | |
Kevin Paul Herbert | bde6d30 | 2014-12-24 18:43:20 -0800 | [diff] [blame] | 34 | void clear_ioapic(void *ioapic_base) |
Stefan Reinauer | 0401bd8 | 2010-01-16 18:31:34 +0000 | [diff] [blame] | 35 | { |
| 36 | u32 low, high; |
| 37 | u32 i, ioapic_interrupts; |
| 38 | |
Kevin Paul Herbert | bde6d30 | 2014-12-24 18:43:20 -0800 | [diff] [blame] | 39 | printk(BIOS_DEBUG, "IOAPIC: Clearing IOAPIC at %p\n", ioapic_base); |
Stefan Reinauer | 0401bd8 | 2010-01-16 18:31:34 +0000 | [diff] [blame] | 40 | |
Patrick Georgi | d1de45e | 2013-01-23 13:45:23 +0100 | [diff] [blame] | 41 | ioapic_interrupts = ioapic_interrupt_count(ioapic_base); |
Stefan Reinauer | 0401bd8 | 2010-01-16 18:31:34 +0000 | [diff] [blame] | 42 | |
Marc Jones | f7dc972 | 2018-03-31 22:45:35 -0600 | [diff] [blame] | 43 | low = INT_DISABLED; |
Stefan Reinauer | 0401bd8 | 2010-01-16 18:31:34 +0000 | [diff] [blame] | 44 | high = NONE; |
| 45 | |
| 46 | for (i = 0; i < ioapic_interrupts; i++) { |
| 47 | io_apic_write(ioapic_base, i * 2 + 0x10, low); |
| 48 | io_apic_write(ioapic_base, i * 2 + 0x11, high); |
| 49 | |
Uwe Hermann | e4990365 | 2010-10-14 23:40:10 +0000 | [diff] [blame] | 50 | printk(BIOS_SPEW, "IOAPIC: reg 0x%08x value 0x%08x 0x%08x\n", |
| 51 | i, high, low); |
Stefan Reinauer | 0401bd8 | 2010-01-16 18:31:34 +0000 | [diff] [blame] | 52 | } |
| 53 | |
| 54 | if (io_apic_read(ioapic_base, 0x10) == 0xffffffff) { |
Uwe Hermann | e4990365 | 2010-10-14 23:40:10 +0000 | [diff] [blame] | 55 | printk(BIOS_WARNING, "IOAPIC not responding.\n"); |
Stefan Reinauer | 0401bd8 | 2010-01-16 18:31:34 +0000 | [diff] [blame] | 56 | return; |
| 57 | } |
| 58 | } |
| 59 | |
Kevin Paul Herbert | bde6d30 | 2014-12-24 18:43:20 -0800 | [diff] [blame] | 60 | void set_ioapic_id(void *ioapic_base, u8 ioapic_id) |
Stefan Reinauer | 0401bd8 | 2010-01-16 18:31:34 +0000 | [diff] [blame] | 61 | { |
| 62 | u32 bsp_lapicid = lapicid(); |
Paul Menzel | 1b3e176 | 2013-04-23 14:49:41 +0200 | [diff] [blame] | 63 | int i; |
Stefan Reinauer | 0401bd8 | 2010-01-16 18:31:34 +0000 | [diff] [blame] | 64 | |
Julius Werner | 540a980 | 2019-12-09 13:03:29 -0800 | [diff] [blame] | 65 | printk(BIOS_DEBUG, "IOAPIC: Initializing IOAPIC at %p\n", |
Uwe Hermann | e4990365 | 2010-10-14 23:40:10 +0000 | [diff] [blame] | 66 | ioapic_base); |
| 67 | printk(BIOS_DEBUG, "IOAPIC: Bootstrap Processor Local APIC = 0x%02x\n", |
| 68 | bsp_lapicid); |
Stefan Reinauer | 0401bd8 | 2010-01-16 18:31:34 +0000 | [diff] [blame] | 69 | |
| 70 | if (ioapic_id) { |
Stefan Reinauer | 14e2277 | 2010-04-27 06:56:47 +0000 | [diff] [blame] | 71 | printk(BIOS_DEBUG, "IOAPIC: ID = 0x%02x\n", ioapic_id); |
Uwe Hermann | e4990365 | 2010-10-14 23:40:10 +0000 | [diff] [blame] | 72 | /* Set IOAPIC ID if it has been specified. */ |
Stefan Reinauer | 14e2277 | 2010-04-27 06:56:47 +0000 | [diff] [blame] | 73 | io_apic_write(ioapic_base, 0x00, |
Kyösti Mälkki | 939103c | 2011-10-19 07:23:51 +0300 | [diff] [blame] | 74 | (io_apic_read(ioapic_base, 0x00) & 0xf0ffffff) | |
Uwe Hermann | e4990365 | 2010-10-14 23:40:10 +0000 | [diff] [blame] | 75 | (ioapic_id << 24)); |
Stefan Reinauer | 0401bd8 | 2010-01-16 18:31:34 +0000 | [diff] [blame] | 76 | } |
Paul Menzel | 1b3e176 | 2013-04-23 14:49:41 +0200 | [diff] [blame] | 77 | |
| 78 | printk(BIOS_SPEW, "IOAPIC: Dumping registers\n"); |
| 79 | for (i = 0; i < 3; i++) |
| 80 | printk(BIOS_SPEW, " reg 0x%04x: 0x%08x\n", i, |
| 81 | io_apic_read(ioapic_base, i)); |
| 82 | |
Kyösti Mälkki | db4f875 | 2012-01-31 17:24:12 +0200 | [diff] [blame] | 83 | } |
| 84 | |
Kevin Paul Herbert | bde6d30 | 2014-12-24 18:43:20 -0800 | [diff] [blame] | 85 | static void load_vectors(void *ioapic_base) |
Kyösti Mälkki | db4f875 | 2012-01-31 17:24:12 +0200 | [diff] [blame] | 86 | { |
| 87 | u32 bsp_lapicid = lapicid(); |
| 88 | u32 low, high; |
| 89 | u32 i, ioapic_interrupts; |
Stefan Reinauer | 0401bd8 | 2010-01-16 18:31:34 +0000 | [diff] [blame] | 90 | |
Patrick Georgi | d1de45e | 2013-01-23 13:45:23 +0100 | [diff] [blame] | 91 | ioapic_interrupts = ioapic_interrupt_count(ioapic_base); |
Stefan Reinauer | 0401bd8 | 2010-01-16 18:31:34 +0000 | [diff] [blame] | 92 | |
Julius Werner | cd49cce | 2019-03-05 16:53:33 -0800 | [diff] [blame] | 93 | if (CONFIG(IOAPIC_INTERRUPTS_ON_FSB)) { |
Martin Roth | 898a775 | 2017-06-01 11:39:59 -0600 | [diff] [blame] | 94 | /* |
| 95 | * For the Pentium 4 and above APICs deliver their interrupts |
| 96 | * on the front side bus, enable that. |
| 97 | */ |
| 98 | printk(BIOS_DEBUG, "IOAPIC: Enabling interrupts on FSB\n"); |
| 99 | io_apic_write(ioapic_base, 0x03, |
| 100 | io_apic_read(ioapic_base, 0x03) | (1 << 0)); |
Julius Werner | cd49cce | 2019-03-05 16:53:33 -0800 | [diff] [blame] | 101 | } else if (CONFIG(IOAPIC_INTERRUPTS_ON_APIC_SERIAL_BUS)) { |
Martin Roth | 898a775 | 2017-06-01 11:39:59 -0600 | [diff] [blame] | 102 | printk(BIOS_DEBUG, |
| 103 | "IOAPIC: Enabling interrupts on APIC serial bus\n"); |
| 104 | io_apic_write(ioapic_base, 0x03, 0); |
| 105 | } |
Stefan Reinauer | 0401bd8 | 2010-01-16 18:31:34 +0000 | [diff] [blame] | 106 | |
Uwe Hermann | e4990365 | 2010-10-14 23:40:10 +0000 | [diff] [blame] | 107 | /* Enable Virtual Wire Mode. */ |
Marc Jones | f7dc972 | 2018-03-31 22:45:35 -0600 | [diff] [blame] | 108 | low = INT_ENABLED | TRIGGER_EDGE | POLARITY_HIGH | PHYSICAL_DEST | ExtINT; |
Stefan Reinauer | 0401bd8 | 2010-01-16 18:31:34 +0000 | [diff] [blame] | 109 | high = bsp_lapicid << (56 - 32); |
| 110 | |
| 111 | io_apic_write(ioapic_base, 0x10, low); |
| 112 | io_apic_write(ioapic_base, 0x11, high); |
| 113 | |
| 114 | if (io_apic_read(ioapic_base, 0x10) == 0xffffffff) { |
Uwe Hermann | e4990365 | 2010-10-14 23:40:10 +0000 | [diff] [blame] | 115 | printk(BIOS_WARNING, "IOAPIC not responding.\n"); |
Stefan Reinauer | 0401bd8 | 2010-01-16 18:31:34 +0000 | [diff] [blame] | 116 | return; |
| 117 | } |
| 118 | |
Uwe Hermann | e4990365 | 2010-10-14 23:40:10 +0000 | [diff] [blame] | 119 | printk(BIOS_SPEW, "IOAPIC: reg 0x%08x value 0x%08x 0x%08x\n", |
| 120 | 0, high, low); |
Marc Jones | f7dc972 | 2018-03-31 22:45:35 -0600 | [diff] [blame] | 121 | low = INT_DISABLED; |
Stefan Reinauer | 0401bd8 | 2010-01-16 18:31:34 +0000 | [diff] [blame] | 122 | high = NONE; |
Stefan Reinauer | 0401bd8 | 2010-01-16 18:31:34 +0000 | [diff] [blame] | 123 | for (i = 1; i < ioapic_interrupts; i++) { |
| 124 | io_apic_write(ioapic_base, i * 2 + 0x10, low); |
| 125 | io_apic_write(ioapic_base, i * 2 + 0x11, high); |
| 126 | |
Uwe Hermann | e4990365 | 2010-10-14 23:40:10 +0000 | [diff] [blame] | 127 | printk(BIOS_SPEW, "IOAPIC: reg 0x%08x value 0x%08x 0x%08x\n", |
| 128 | i, high, low); |
Eric Biederman | 5899fd8 | 2003-04-24 06:25:08 +0000 | [diff] [blame] | 129 | } |
| 130 | } |
Kyösti Mälkki | db4f875 | 2012-01-31 17:24:12 +0200 | [diff] [blame] | 131 | |
Kevin Paul Herbert | bde6d30 | 2014-12-24 18:43:20 -0800 | [diff] [blame] | 132 | void setup_ioapic(void *ioapic_base, u8 ioapic_id) |
Kyösti Mälkki | db4f875 | 2012-01-31 17:24:12 +0200 | [diff] [blame] | 133 | { |
| 134 | set_ioapic_id(ioapic_base, ioapic_id); |
| 135 | load_vectors(ioapic_base); |
| 136 | } |