root / hw / ioapic.c @ 0ed8b6f6
History | View | Annotate | Download (7.4 kB)
1 | 610626af | aliguori | /*
|
---|---|---|---|
2 | 610626af | aliguori | * ioapic.c IOAPIC emulation logic
|
3 | 610626af | aliguori | *
|
4 | 610626af | aliguori | * Copyright (c) 2004-2005 Fabrice Bellard
|
5 | 610626af | aliguori | *
|
6 | 610626af | aliguori | * Split the ioapic logic from apic.c
|
7 | 610626af | aliguori | * Xiantao Zhang <xiantao.zhang@intel.com>
|
8 | 610626af | aliguori | *
|
9 | 610626af | aliguori | * This library is free software; you can redistribute it and/or
|
10 | 610626af | aliguori | * modify it under the terms of the GNU Lesser General Public
|
11 | 610626af | aliguori | * License as published by the Free Software Foundation; either
|
12 | 610626af | aliguori | * version 2 of the License, or (at your option) any later version.
|
13 | 610626af | aliguori | *
|
14 | 610626af | aliguori | * This library is distributed in the hope that it will be useful,
|
15 | 610626af | aliguori | * but WITHOUT ANY WARRANTY; without even the implied warranty of
|
16 | 610626af | aliguori | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
|
17 | 610626af | aliguori | * Lesser General Public License for more details.
|
18 | 610626af | aliguori | *
|
19 | 610626af | aliguori | * You should have received a copy of the GNU Lesser General Public
|
20 | 8167ee88 | Blue Swirl | * License along with this library; if not, see <http://www.gnu.org/licenses/>.
|
21 | 610626af | aliguori | */
|
22 | 610626af | aliguori | |
23 | 610626af | aliguori | #include "hw.h" |
24 | 610626af | aliguori | #include "pc.h" |
25 | aa28b9bf | Blue Swirl | #include "apic.h" |
26 | 0280b571 | Jan Kiszka | #include "ioapic.h" |
27 | 244ac3af | Jan Kiszka | #include "ioapic_internal.h" |
28 | 610626af | aliguori | |
29 | 610626af | aliguori | //#define DEBUG_IOAPIC
|
30 | 610626af | aliguori | |
31 | 9af9b330 | Blue Swirl | #ifdef DEBUG_IOAPIC
|
32 | 9af9b330 | Blue Swirl | #define DPRINTF(fmt, ...) \
|
33 | 9af9b330 | Blue Swirl | do { printf("ioapic: " fmt , ## __VA_ARGS__); } while (0) |
34 | 9af9b330 | Blue Swirl | #else
|
35 | 9af9b330 | Blue Swirl | #define DPRINTF(fmt, ...)
|
36 | 9af9b330 | Blue Swirl | #endif
|
37 | 9af9b330 | Blue Swirl | |
38 | 244ac3af | Jan Kiszka | static IOAPICCommonState *ioapics[MAX_IOAPICS];
|
39 | 0280b571 | Jan Kiszka | |
40 | 244ac3af | Jan Kiszka | static void ioapic_service(IOAPICCommonState *s) |
41 | 610626af | aliguori | { |
42 | 610626af | aliguori | uint8_t i; |
43 | 610626af | aliguori | uint8_t trig_mode; |
44 | 610626af | aliguori | uint8_t vector; |
45 | 610626af | aliguori | uint8_t delivery_mode; |
46 | 610626af | aliguori | uint32_t mask; |
47 | 610626af | aliguori | uint64_t entry; |
48 | 610626af | aliguori | uint8_t dest; |
49 | 610626af | aliguori | uint8_t dest_mode; |
50 | 610626af | aliguori | |
51 | 610626af | aliguori | for (i = 0; i < IOAPIC_NUM_PINS; i++) { |
52 | 610626af | aliguori | mask = 1 << i;
|
53 | 610626af | aliguori | if (s->irr & mask) {
|
54 | 610626af | aliguori | entry = s->ioredtbl[i]; |
55 | 610626af | aliguori | if (!(entry & IOAPIC_LVT_MASKED)) {
|
56 | 1f5e71a8 | Jan Kiszka | trig_mode = ((entry >> IOAPIC_LVT_TRIGGER_MODE_SHIFT) & 1);
|
57 | 1f5e71a8 | Jan Kiszka | dest = entry >> IOAPIC_LVT_DEST_SHIFT; |
58 | 1f5e71a8 | Jan Kiszka | dest_mode = (entry >> IOAPIC_LVT_DEST_MODE_SHIFT) & 1;
|
59 | 1f5e71a8 | Jan Kiszka | delivery_mode = |
60 | 1f5e71a8 | Jan Kiszka | (entry >> IOAPIC_LVT_DELIV_MODE_SHIFT) & IOAPIC_DM_MASK; |
61 | 0280b571 | Jan Kiszka | if (trig_mode == IOAPIC_TRIGGER_EDGE) {
|
62 | 610626af | aliguori | s->irr &= ~mask; |
63 | 0280b571 | Jan Kiszka | } else {
|
64 | 0280b571 | Jan Kiszka | s->ioredtbl[i] |= IOAPIC_LVT_REMOTE_IRR; |
65 | 0280b571 | Jan Kiszka | } |
66 | 1f5e71a8 | Jan Kiszka | if (delivery_mode == IOAPIC_DM_EXTINT) {
|
67 | 610626af | aliguori | vector = pic_read_irq(isa_pic); |
68 | 1f5e71a8 | Jan Kiszka | } else {
|
69 | 1f5e71a8 | Jan Kiszka | vector = entry & IOAPIC_VECTOR_MASK; |
70 | 1f5e71a8 | Jan Kiszka | } |
71 | 610626af | aliguori | apic_deliver_irq(dest, dest_mode, delivery_mode, |
72 | 1f6f408c | Jan Kiszka | vector, trig_mode); |
73 | 610626af | aliguori | } |
74 | 610626af | aliguori | } |
75 | 610626af | aliguori | } |
76 | 610626af | aliguori | } |
77 | 610626af | aliguori | |
78 | 7d0500c4 | Blue Swirl | static void ioapic_set_irq(void *opaque, int vector, int level) |
79 | 610626af | aliguori | { |
80 | 244ac3af | Jan Kiszka | IOAPICCommonState *s = opaque; |
81 | 610626af | aliguori | |
82 | 610626af | aliguori | /* ISA IRQs map to GSI 1-1 except for IRQ0 which maps
|
83 | 610626af | aliguori | * to GSI 2. GSI maps to ioapic 1-1. This is not
|
84 | 610626af | aliguori | * the cleanest way of doing it but it should work. */
|
85 | 610626af | aliguori | |
86 | 1f5e71a8 | Jan Kiszka | DPRINTF("%s: %s vec %x\n", __func__, level ? "raise" : "lower", vector); |
87 | 1f5e71a8 | Jan Kiszka | if (vector == 0) { |
88 | 610626af | aliguori | vector = 2;
|
89 | 1f5e71a8 | Jan Kiszka | } |
90 | 610626af | aliguori | if (vector >= 0 && vector < IOAPIC_NUM_PINS) { |
91 | 610626af | aliguori | uint32_t mask = 1 << vector;
|
92 | 610626af | aliguori | uint64_t entry = s->ioredtbl[vector]; |
93 | 610626af | aliguori | |
94 | 0035e509 | Jan Kiszka | if (entry & (1 << IOAPIC_LVT_POLARITY_SHIFT)) { |
95 | 0035e509 | Jan Kiszka | level = !level; |
96 | 0035e509 | Jan Kiszka | } |
97 | 1f5e71a8 | Jan Kiszka | if (((entry >> IOAPIC_LVT_TRIGGER_MODE_SHIFT) & 1) == |
98 | 1f5e71a8 | Jan Kiszka | IOAPIC_TRIGGER_LEVEL) { |
99 | 610626af | aliguori | /* level triggered */
|
100 | 610626af | aliguori | if (level) {
|
101 | 610626af | aliguori | s->irr |= mask; |
102 | 610626af | aliguori | ioapic_service(s); |
103 | 610626af | aliguori | } else {
|
104 | 610626af | aliguori | s->irr &= ~mask; |
105 | 610626af | aliguori | } |
106 | 610626af | aliguori | } else {
|
107 | 47f7be39 | Jan Kiszka | /* According to the 82093AA manual, we must ignore edge requests
|
108 | 47f7be39 | Jan Kiszka | * if the input pin is masked. */
|
109 | 47f7be39 | Jan Kiszka | if (level && !(entry & IOAPIC_LVT_MASKED)) {
|
110 | 610626af | aliguori | s->irr |= mask; |
111 | 610626af | aliguori | ioapic_service(s); |
112 | 610626af | aliguori | } |
113 | 610626af | aliguori | } |
114 | 610626af | aliguori | } |
115 | 610626af | aliguori | } |
116 | 610626af | aliguori | |
117 | 0280b571 | Jan Kiszka | void ioapic_eoi_broadcast(int vector) |
118 | 0280b571 | Jan Kiszka | { |
119 | 244ac3af | Jan Kiszka | IOAPICCommonState *s; |
120 | 0280b571 | Jan Kiszka | uint64_t entry; |
121 | 0280b571 | Jan Kiszka | int i, n;
|
122 | 0280b571 | Jan Kiszka | |
123 | 0280b571 | Jan Kiszka | for (i = 0; i < MAX_IOAPICS; i++) { |
124 | 0280b571 | Jan Kiszka | s = ioapics[i]; |
125 | 0280b571 | Jan Kiszka | if (!s) {
|
126 | 0280b571 | Jan Kiszka | continue;
|
127 | 0280b571 | Jan Kiszka | } |
128 | 0280b571 | Jan Kiszka | for (n = 0; n < IOAPIC_NUM_PINS; n++) { |
129 | 0280b571 | Jan Kiszka | entry = s->ioredtbl[n]; |
130 | 1f5e71a8 | Jan Kiszka | if ((entry & IOAPIC_LVT_REMOTE_IRR)
|
131 | 1f5e71a8 | Jan Kiszka | && (entry & IOAPIC_VECTOR_MASK) == vector) { |
132 | 0280b571 | Jan Kiszka | s->ioredtbl[n] = entry & ~IOAPIC_LVT_REMOTE_IRR; |
133 | 0280b571 | Jan Kiszka | if (!(entry & IOAPIC_LVT_MASKED) && (s->irr & (1 << n))) { |
134 | 0280b571 | Jan Kiszka | ioapic_service(s); |
135 | 0280b571 | Jan Kiszka | } |
136 | 0280b571 | Jan Kiszka | } |
137 | 0280b571 | Jan Kiszka | } |
138 | 0280b571 | Jan Kiszka | } |
139 | 0280b571 | Jan Kiszka | } |
140 | 0280b571 | Jan Kiszka | |
141 | 4d5bf5f6 | Jan Kiszka | static uint64_t
|
142 | 4d5bf5f6 | Jan Kiszka | ioapic_mem_read(void *opaque, target_phys_addr_t addr, unsigned int size) |
143 | 610626af | aliguori | { |
144 | 244ac3af | Jan Kiszka | IOAPICCommonState *s = opaque; |
145 | 610626af | aliguori | int index;
|
146 | 610626af | aliguori | uint32_t val = 0;
|
147 | 610626af | aliguori | |
148 | 1f5e71a8 | Jan Kiszka | switch (addr & 0xff) { |
149 | 1f5e71a8 | Jan Kiszka | case IOAPIC_IOREGSEL:
|
150 | 610626af | aliguori | val = s->ioregsel; |
151 | 1f5e71a8 | Jan Kiszka | break;
|
152 | 1f5e71a8 | Jan Kiszka | case IOAPIC_IOWIN:
|
153 | 1a440963 | Jan Kiszka | if (size != 4) { |
154 | 1a440963 | Jan Kiszka | break;
|
155 | 1a440963 | Jan Kiszka | } |
156 | 610626af | aliguori | switch (s->ioregsel) {
|
157 | 1f5e71a8 | Jan Kiszka | case IOAPIC_REG_ID:
|
158 | 1f5e71a8 | Jan Kiszka | val = s->id << IOAPIC_ID_SHIFT; |
159 | 1f5e71a8 | Jan Kiszka | break;
|
160 | 1f5e71a8 | Jan Kiszka | case IOAPIC_REG_VER:
|
161 | 1f5e71a8 | Jan Kiszka | val = IOAPIC_VERSION | |
162 | 1f5e71a8 | Jan Kiszka | ((IOAPIC_NUM_PINS - 1) << IOAPIC_VER_ENTRIES_SHIFT);
|
163 | 1f5e71a8 | Jan Kiszka | break;
|
164 | 1f5e71a8 | Jan Kiszka | case IOAPIC_REG_ARB:
|
165 | 1f5e71a8 | Jan Kiszka | val = 0;
|
166 | 1f5e71a8 | Jan Kiszka | break;
|
167 | 1f5e71a8 | Jan Kiszka | default:
|
168 | 1f5e71a8 | Jan Kiszka | index = (s->ioregsel - IOAPIC_REG_REDTBL_BASE) >> 1;
|
169 | 1f5e71a8 | Jan Kiszka | if (index >= 0 && index < IOAPIC_NUM_PINS) { |
170 | 1f5e71a8 | Jan Kiszka | if (s->ioregsel & 1) { |
171 | 1f5e71a8 | Jan Kiszka | val = s->ioredtbl[index] >> 32;
|
172 | 1f5e71a8 | Jan Kiszka | } else {
|
173 | 1f5e71a8 | Jan Kiszka | val = s->ioredtbl[index] & 0xffffffff;
|
174 | 610626af | aliguori | } |
175 | 1f5e71a8 | Jan Kiszka | } |
176 | 610626af | aliguori | } |
177 | 9af9b330 | Blue Swirl | DPRINTF("read: %08x = %08x\n", s->ioregsel, val);
|
178 | 1f5e71a8 | Jan Kiszka | break;
|
179 | 610626af | aliguori | } |
180 | 610626af | aliguori | return val;
|
181 | 610626af | aliguori | } |
182 | 610626af | aliguori | |
183 | 1f5e71a8 | Jan Kiszka | static void |
184 | 4d5bf5f6 | Jan Kiszka | ioapic_mem_write(void *opaque, target_phys_addr_t addr, uint64_t val,
|
185 | 4d5bf5f6 | Jan Kiszka | unsigned int size) |
186 | 610626af | aliguori | { |
187 | 244ac3af | Jan Kiszka | IOAPICCommonState *s = opaque; |
188 | 610626af | aliguori | int index;
|
189 | 610626af | aliguori | |
190 | 1f5e71a8 | Jan Kiszka | switch (addr & 0xff) { |
191 | 1f5e71a8 | Jan Kiszka | case IOAPIC_IOREGSEL:
|
192 | 610626af | aliguori | s->ioregsel = val; |
193 | 1f5e71a8 | Jan Kiszka | break;
|
194 | 1f5e71a8 | Jan Kiszka | case IOAPIC_IOWIN:
|
195 | 1a440963 | Jan Kiszka | if (size != 4) { |
196 | 1a440963 | Jan Kiszka | break;
|
197 | 1a440963 | Jan Kiszka | } |
198 | 0c1f781b | Jason Wang | DPRINTF("write: %08x = %08" PRIx64 "\n", s->ioregsel, val); |
199 | 610626af | aliguori | switch (s->ioregsel) {
|
200 | 1f5e71a8 | Jan Kiszka | case IOAPIC_REG_ID:
|
201 | 1f5e71a8 | Jan Kiszka | s->id = (val >> IOAPIC_ID_SHIFT) & IOAPIC_ID_MASK; |
202 | 1f5e71a8 | Jan Kiszka | break;
|
203 | 1f5e71a8 | Jan Kiszka | case IOAPIC_REG_VER:
|
204 | 1f5e71a8 | Jan Kiszka | case IOAPIC_REG_ARB:
|
205 | 1f5e71a8 | Jan Kiszka | break;
|
206 | 1f5e71a8 | Jan Kiszka | default:
|
207 | 1f5e71a8 | Jan Kiszka | index = (s->ioregsel - IOAPIC_REG_REDTBL_BASE) >> 1;
|
208 | 1f5e71a8 | Jan Kiszka | if (index >= 0 && index < IOAPIC_NUM_PINS) { |
209 | 1f5e71a8 | Jan Kiszka | if (s->ioregsel & 1) { |
210 | 1f5e71a8 | Jan Kiszka | s->ioredtbl[index] &= 0xffffffff;
|
211 | 1f5e71a8 | Jan Kiszka | s->ioredtbl[index] |= (uint64_t)val << 32;
|
212 | 1f5e71a8 | Jan Kiszka | } else {
|
213 | 1f5e71a8 | Jan Kiszka | s->ioredtbl[index] &= ~0xffffffffULL;
|
214 | 1f5e71a8 | Jan Kiszka | s->ioredtbl[index] |= val; |
215 | 610626af | aliguori | } |
216 | 1f5e71a8 | Jan Kiszka | ioapic_service(s); |
217 | 1f5e71a8 | Jan Kiszka | } |
218 | 610626af | aliguori | } |
219 | 1f5e71a8 | Jan Kiszka | break;
|
220 | 610626af | aliguori | } |
221 | 610626af | aliguori | } |
222 | 610626af | aliguori | |
223 | 4d5bf5f6 | Jan Kiszka | static const MemoryRegionOps ioapic_io_ops = { |
224 | 4d5bf5f6 | Jan Kiszka | .read = ioapic_mem_read, |
225 | 4d5bf5f6 | Jan Kiszka | .write = ioapic_mem_write, |
226 | 4d5bf5f6 | Jan Kiszka | .endianness = DEVICE_NATIVE_ENDIAN, |
227 | 610626af | aliguori | }; |
228 | 610626af | aliguori | |
229 | 244ac3af | Jan Kiszka | static void ioapic_init(IOAPICCommonState *s, int instance_no) |
230 | 610626af | aliguori | { |
231 | 4d5bf5f6 | Jan Kiszka | memory_region_init_io(&s->io_memory, &ioapic_io_ops, s, "ioapic", 0x1000); |
232 | 610626af | aliguori | |
233 | 244ac3af | Jan Kiszka | qdev_init_gpio_in(&s->busdev.qdev, ioapic_set_irq, IOAPIC_NUM_PINS); |
234 | 0280b571 | Jan Kiszka | |
235 | 244ac3af | Jan Kiszka | ioapics[instance_no] = s; |
236 | 610626af | aliguori | } |
237 | 96051119 | Blue Swirl | |
238 | 999e12bb | Anthony Liguori | static void ioapic_class_init(ObjectClass *klass, void *data) |
239 | 999e12bb | Anthony Liguori | { |
240 | 999e12bb | Anthony Liguori | IOAPICCommonClass *k = IOAPIC_COMMON_CLASS(klass); |
241 | 39bffca2 | Anthony Liguori | DeviceClass *dc = DEVICE_CLASS(klass); |
242 | 999e12bb | Anthony Liguori | |
243 | 999e12bb | Anthony Liguori | k->init = ioapic_init; |
244 | 39bffca2 | Anthony Liguori | dc->reset = ioapic_reset_common; |
245 | 999e12bb | Anthony Liguori | } |
246 | 999e12bb | Anthony Liguori | |
247 | 39bffca2 | Anthony Liguori | static TypeInfo ioapic_info = {
|
248 | 39bffca2 | Anthony Liguori | .name = "ioapic",
|
249 | 39bffca2 | Anthony Liguori | .parent = TYPE_IOAPIC_COMMON, |
250 | 39bffca2 | Anthony Liguori | .instance_size = sizeof(IOAPICCommonState),
|
251 | 39bffca2 | Anthony Liguori | .class_init = ioapic_class_init, |
252 | 96051119 | Blue Swirl | }; |
253 | 96051119 | Blue Swirl | |
254 | 83f7d43a | Andreas Färber | static void ioapic_register_types(void) |
255 | 96051119 | Blue Swirl | { |
256 | 39bffca2 | Anthony Liguori | type_register_static(&ioapic_info); |
257 | 96051119 | Blue Swirl | } |
258 | 96051119 | Blue Swirl | |
259 | 83f7d43a | Andreas Färber | type_init(ioapic_register_types) |