]> git.proxmox.com Git - mirror_qemu.git/blob - hw/omap_intc.c
hw/omap_intc.c: Avoid crash on access to nonexistent banked registers
[mirror_qemu.git] / hw / omap_intc.c
1 /*
2 * TI OMAP interrupt controller emulation.
3 *
4 * Copyright (C) 2006-2008 Andrzej Zaborowski <balrog@zabor.org>
5 * Copyright (C) 2007-2008 Nokia Corporation
6 *
7 * This program is free software; you can redistribute it and/or
8 * modify it under the terms of the GNU General Public License as
9 * published by the Free Software Foundation; either version 2 or
10 * (at your option) version 3 of the License.
11 *
12 * This program is distributed in the hope that it will be useful,
13 * but WITHOUT ANY WARRANTY; without even the implied warranty of
14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
15 * GNU General Public License for more details.
16 *
17 * You should have received a copy of the GNU General Public License along
18 * with this program; if not, see <http://www.gnu.org/licenses/>.
19 */
20 #include "hw.h"
21 #include "omap.h"
22 #include "sysbus.h"
23
24 /* Interrupt Handlers */
25 struct omap_intr_handler_bank_s {
26 uint32_t irqs;
27 uint32_t inputs;
28 uint32_t mask;
29 uint32_t fiq;
30 uint32_t sens_edge;
31 uint32_t swi;
32 unsigned char priority[32];
33 };
34
35 struct omap_intr_handler_s {
36 SysBusDevice busdev;
37 qemu_irq *pins;
38 qemu_irq parent_intr[2];
39 MemoryRegion mmio;
40 void *iclk;
41 void *fclk;
42 unsigned char nbanks;
43 int level_only;
44 uint32_t size;
45
46 uint8_t revision;
47
48 /* state */
49 uint32_t new_agr[2];
50 int sir_intr[2];
51 int autoidle;
52 uint32_t mask;
53 struct omap_intr_handler_bank_s bank[3];
54 };
55
56 static void omap_inth_sir_update(struct omap_intr_handler_s *s, int is_fiq)
57 {
58 int i, j, sir_intr, p_intr, p, f;
59 uint32_t level;
60 sir_intr = 0;
61 p_intr = 255;
62
63 /* Find the interrupt line with the highest dynamic priority.
64 * Note: 0 denotes the hightest priority.
65 * If all interrupts have the same priority, the default order is IRQ_N,
66 * IRQ_N-1,...,IRQ_0. */
67 for (j = 0; j < s->nbanks; ++j) {
68 level = s->bank[j].irqs & ~s->bank[j].mask &
69 (is_fiq ? s->bank[j].fiq : ~s->bank[j].fiq);
70 for (f = ffs(level), i = f - 1, level >>= f - 1; f; i += f,
71 level >>= f) {
72 p = s->bank[j].priority[i];
73 if (p <= p_intr) {
74 p_intr = p;
75 sir_intr = 32 * j + i;
76 }
77 f = ffs(level >> 1);
78 }
79 }
80 s->sir_intr[is_fiq] = sir_intr;
81 }
82
83 static inline void omap_inth_update(struct omap_intr_handler_s *s, int is_fiq)
84 {
85 int i;
86 uint32_t has_intr = 0;
87
88 for (i = 0; i < s->nbanks; ++i)
89 has_intr |= s->bank[i].irqs & ~s->bank[i].mask &
90 (is_fiq ? s->bank[i].fiq : ~s->bank[i].fiq);
91
92 if (s->new_agr[is_fiq] & has_intr & s->mask) {
93 s->new_agr[is_fiq] = 0;
94 omap_inth_sir_update(s, is_fiq);
95 qemu_set_irq(s->parent_intr[is_fiq], 1);
96 }
97 }
98
99 #define INT_FALLING_EDGE 0
100 #define INT_LOW_LEVEL 1
101
102 static void omap_set_intr(void *opaque, int irq, int req)
103 {
104 struct omap_intr_handler_s *ih = (struct omap_intr_handler_s *) opaque;
105 uint32_t rise;
106
107 struct omap_intr_handler_bank_s *bank = &ih->bank[irq >> 5];
108 int n = irq & 31;
109
110 if (req) {
111 rise = ~bank->irqs & (1 << n);
112 if (~bank->sens_edge & (1 << n))
113 rise &= ~bank->inputs;
114
115 bank->inputs |= (1 << n);
116 if (rise) {
117 bank->irqs |= rise;
118 omap_inth_update(ih, 0);
119 omap_inth_update(ih, 1);
120 }
121 } else {
122 rise = bank->sens_edge & bank->irqs & (1 << n);
123 bank->irqs &= ~rise;
124 bank->inputs &= ~(1 << n);
125 }
126 }
127
128 /* Simplified version with no edge detection */
129 static void omap_set_intr_noedge(void *opaque, int irq, int req)
130 {
131 struct omap_intr_handler_s *ih = (struct omap_intr_handler_s *) opaque;
132 uint32_t rise;
133
134 struct omap_intr_handler_bank_s *bank = &ih->bank[irq >> 5];
135 int n = irq & 31;
136
137 if (req) {
138 rise = ~bank->inputs & (1 << n);
139 if (rise) {
140 bank->irqs |= bank->inputs |= rise;
141 omap_inth_update(ih, 0);
142 omap_inth_update(ih, 1);
143 }
144 } else
145 bank->irqs = (bank->inputs &= ~(1 << n)) | bank->swi;
146 }
147
148 static uint64_t omap_inth_read(void *opaque, target_phys_addr_t addr,
149 unsigned size)
150 {
151 struct omap_intr_handler_s *s = (struct omap_intr_handler_s *) opaque;
152 int i, offset = addr;
153 int bank_no = offset >> 8;
154 int line_no;
155 struct omap_intr_handler_bank_s *bank = &s->bank[bank_no];
156 offset &= 0xff;
157
158 switch (offset) {
159 case 0x00: /* ITR */
160 return bank->irqs;
161
162 case 0x04: /* MIR */
163 return bank->mask;
164
165 case 0x10: /* SIR_IRQ_CODE */
166 case 0x14: /* SIR_FIQ_CODE */
167 if (bank_no != 0)
168 break;
169 line_no = s->sir_intr[(offset - 0x10) >> 2];
170 bank = &s->bank[line_no >> 5];
171 i = line_no & 31;
172 if (((bank->sens_edge >> i) & 1) == INT_FALLING_EDGE)
173 bank->irqs &= ~(1 << i);
174 return line_no;
175
176 case 0x18: /* CONTROL_REG */
177 if (bank_no != 0)
178 break;
179 return 0;
180
181 case 0x1c: /* ILR0 */
182 case 0x20: /* ILR1 */
183 case 0x24: /* ILR2 */
184 case 0x28: /* ILR3 */
185 case 0x2c: /* ILR4 */
186 case 0x30: /* ILR5 */
187 case 0x34: /* ILR6 */
188 case 0x38: /* ILR7 */
189 case 0x3c: /* ILR8 */
190 case 0x40: /* ILR9 */
191 case 0x44: /* ILR10 */
192 case 0x48: /* ILR11 */
193 case 0x4c: /* ILR12 */
194 case 0x50: /* ILR13 */
195 case 0x54: /* ILR14 */
196 case 0x58: /* ILR15 */
197 case 0x5c: /* ILR16 */
198 case 0x60: /* ILR17 */
199 case 0x64: /* ILR18 */
200 case 0x68: /* ILR19 */
201 case 0x6c: /* ILR20 */
202 case 0x70: /* ILR21 */
203 case 0x74: /* ILR22 */
204 case 0x78: /* ILR23 */
205 case 0x7c: /* ILR24 */
206 case 0x80: /* ILR25 */
207 case 0x84: /* ILR26 */
208 case 0x88: /* ILR27 */
209 case 0x8c: /* ILR28 */
210 case 0x90: /* ILR29 */
211 case 0x94: /* ILR30 */
212 case 0x98: /* ILR31 */
213 i = (offset - 0x1c) >> 2;
214 return (bank->priority[i] << 2) |
215 (((bank->sens_edge >> i) & 1) << 1) |
216 ((bank->fiq >> i) & 1);
217
218 case 0x9c: /* ISR */
219 return 0x00000000;
220
221 }
222 OMAP_BAD_REG(addr);
223 return 0;
224 }
225
226 static void omap_inth_write(void *opaque, target_phys_addr_t addr,
227 uint64_t value, unsigned size)
228 {
229 struct omap_intr_handler_s *s = (struct omap_intr_handler_s *) opaque;
230 int i, offset = addr;
231 int bank_no = offset >> 8;
232 struct omap_intr_handler_bank_s *bank = &s->bank[bank_no];
233 offset &= 0xff;
234
235 switch (offset) {
236 case 0x00: /* ITR */
237 /* Important: ignore the clearing if the IRQ is level-triggered and
238 the input bit is 1 */
239 bank->irqs &= value | (bank->inputs & bank->sens_edge);
240 return;
241
242 case 0x04: /* MIR */
243 bank->mask = value;
244 omap_inth_update(s, 0);
245 omap_inth_update(s, 1);
246 return;
247
248 case 0x10: /* SIR_IRQ_CODE */
249 case 0x14: /* SIR_FIQ_CODE */
250 OMAP_RO_REG(addr);
251 break;
252
253 case 0x18: /* CONTROL_REG */
254 if (bank_no != 0)
255 break;
256 if (value & 2) {
257 qemu_set_irq(s->parent_intr[1], 0);
258 s->new_agr[1] = ~0;
259 omap_inth_update(s, 1);
260 }
261 if (value & 1) {
262 qemu_set_irq(s->parent_intr[0], 0);
263 s->new_agr[0] = ~0;
264 omap_inth_update(s, 0);
265 }
266 return;
267
268 case 0x1c: /* ILR0 */
269 case 0x20: /* ILR1 */
270 case 0x24: /* ILR2 */
271 case 0x28: /* ILR3 */
272 case 0x2c: /* ILR4 */
273 case 0x30: /* ILR5 */
274 case 0x34: /* ILR6 */
275 case 0x38: /* ILR7 */
276 case 0x3c: /* ILR8 */
277 case 0x40: /* ILR9 */
278 case 0x44: /* ILR10 */
279 case 0x48: /* ILR11 */
280 case 0x4c: /* ILR12 */
281 case 0x50: /* ILR13 */
282 case 0x54: /* ILR14 */
283 case 0x58: /* ILR15 */
284 case 0x5c: /* ILR16 */
285 case 0x60: /* ILR17 */
286 case 0x64: /* ILR18 */
287 case 0x68: /* ILR19 */
288 case 0x6c: /* ILR20 */
289 case 0x70: /* ILR21 */
290 case 0x74: /* ILR22 */
291 case 0x78: /* ILR23 */
292 case 0x7c: /* ILR24 */
293 case 0x80: /* ILR25 */
294 case 0x84: /* ILR26 */
295 case 0x88: /* ILR27 */
296 case 0x8c: /* ILR28 */
297 case 0x90: /* ILR29 */
298 case 0x94: /* ILR30 */
299 case 0x98: /* ILR31 */
300 i = (offset - 0x1c) >> 2;
301 bank->priority[i] = (value >> 2) & 0x1f;
302 bank->sens_edge &= ~(1 << i);
303 bank->sens_edge |= ((value >> 1) & 1) << i;
304 bank->fiq &= ~(1 << i);
305 bank->fiq |= (value & 1) << i;
306 return;
307
308 case 0x9c: /* ISR */
309 for (i = 0; i < 32; i ++)
310 if (value & (1 << i)) {
311 omap_set_intr(s, 32 * bank_no + i, 1);
312 return;
313 }
314 return;
315 }
316 OMAP_BAD_REG(addr);
317 }
318
319 static const MemoryRegionOps omap_inth_mem_ops = {
320 .read = omap_inth_read,
321 .write = omap_inth_write,
322 .endianness = DEVICE_NATIVE_ENDIAN,
323 .valid = {
324 .min_access_size = 4,
325 .max_access_size = 4,
326 },
327 };
328
329 static void omap_inth_reset(DeviceState *dev)
330 {
331 struct omap_intr_handler_s *s = FROM_SYSBUS(struct omap_intr_handler_s,
332 sysbus_from_qdev(dev));
333 int i;
334
335 for (i = 0; i < s->nbanks; ++i){
336 s->bank[i].irqs = 0x00000000;
337 s->bank[i].mask = 0xffffffff;
338 s->bank[i].sens_edge = 0x00000000;
339 s->bank[i].fiq = 0x00000000;
340 s->bank[i].inputs = 0x00000000;
341 s->bank[i].swi = 0x00000000;
342 memset(s->bank[i].priority, 0, sizeof(s->bank[i].priority));
343
344 if (s->level_only)
345 s->bank[i].sens_edge = 0xffffffff;
346 }
347
348 s->new_agr[0] = ~0;
349 s->new_agr[1] = ~0;
350 s->sir_intr[0] = 0;
351 s->sir_intr[1] = 0;
352 s->autoidle = 0;
353 s->mask = ~0;
354
355 qemu_set_irq(s->parent_intr[0], 0);
356 qemu_set_irq(s->parent_intr[1], 0);
357 }
358
359 static int omap_intc_init(SysBusDevice *dev)
360 {
361 struct omap_intr_handler_s *s;
362 s = FROM_SYSBUS(struct omap_intr_handler_s, dev);
363 if (!s->iclk) {
364 hw_error("omap-intc: clk not connected\n");
365 }
366 s->nbanks = 1;
367 sysbus_init_irq(dev, &s->parent_intr[0]);
368 sysbus_init_irq(dev, &s->parent_intr[1]);
369 qdev_init_gpio_in(&dev->qdev, omap_set_intr, s->nbanks * 32);
370 memory_region_init_io(&s->mmio, &omap_inth_mem_ops, s,
371 "omap-intc", s->size);
372 sysbus_init_mmio_region(dev, &s->mmio);
373 return 0;
374 }
375
376 static SysBusDeviceInfo omap_intc_info = {
377 .init = omap_intc_init,
378 .qdev.name = "omap-intc",
379 .qdev.size = sizeof(struct omap_intr_handler_s),
380 .qdev.reset = omap_inth_reset,
381 .qdev.props = (Property[]) {
382 DEFINE_PROP_UINT32("size", struct omap_intr_handler_s, size, 0x100),
383 DEFINE_PROP_PTR("clk", struct omap_intr_handler_s, iclk),
384 DEFINE_PROP_END_OF_LIST()
385 }
386 };
387
388 static uint64_t omap2_inth_read(void *opaque, target_phys_addr_t addr,
389 unsigned size)
390 {
391 struct omap_intr_handler_s *s = (struct omap_intr_handler_s *) opaque;
392 int offset = addr;
393 int bank_no, line_no;
394 struct omap_intr_handler_bank_s *bank = NULL;
395
396 if ((offset & 0xf80) == 0x80) {
397 bank_no = (offset & 0x60) >> 5;
398 if (bank_no < s->nbanks) {
399 offset &= ~0x60;
400 bank = &s->bank[bank_no];
401 } else {
402 OMAP_BAD_REG(addr);
403 return 0;
404 }
405 }
406
407 switch (offset) {
408 case 0x00: /* INTC_REVISION */
409 return s->revision;
410
411 case 0x10: /* INTC_SYSCONFIG */
412 return (s->autoidle >> 2) & 1;
413
414 case 0x14: /* INTC_SYSSTATUS */
415 return 1; /* RESETDONE */
416
417 case 0x40: /* INTC_SIR_IRQ */
418 return s->sir_intr[0];
419
420 case 0x44: /* INTC_SIR_FIQ */
421 return s->sir_intr[1];
422
423 case 0x48: /* INTC_CONTROL */
424 return (!s->mask) << 2; /* GLOBALMASK */
425
426 case 0x4c: /* INTC_PROTECTION */
427 return 0;
428
429 case 0x50: /* INTC_IDLE */
430 return s->autoidle & 3;
431
432 /* Per-bank registers */
433 case 0x80: /* INTC_ITR */
434 return bank->inputs;
435
436 case 0x84: /* INTC_MIR */
437 return bank->mask;
438
439 case 0x88: /* INTC_MIR_CLEAR */
440 case 0x8c: /* INTC_MIR_SET */
441 return 0;
442
443 case 0x90: /* INTC_ISR_SET */
444 return bank->swi;
445
446 case 0x94: /* INTC_ISR_CLEAR */
447 return 0;
448
449 case 0x98: /* INTC_PENDING_IRQ */
450 return bank->irqs & ~bank->mask & ~bank->fiq;
451
452 case 0x9c: /* INTC_PENDING_FIQ */
453 return bank->irqs & ~bank->mask & bank->fiq;
454
455 /* Per-line registers */
456 case 0x100 ... 0x300: /* INTC_ILR */
457 bank_no = (offset - 0x100) >> 7;
458 if (bank_no > s->nbanks)
459 break;
460 bank = &s->bank[bank_no];
461 line_no = (offset & 0x7f) >> 2;
462 return (bank->priority[line_no] << 2) |
463 ((bank->fiq >> line_no) & 1);
464 }
465 OMAP_BAD_REG(addr);
466 return 0;
467 }
468
469 static void omap2_inth_write(void *opaque, target_phys_addr_t addr,
470 uint64_t value, unsigned size)
471 {
472 struct omap_intr_handler_s *s = (struct omap_intr_handler_s *) opaque;
473 int offset = addr;
474 int bank_no, line_no;
475 struct omap_intr_handler_bank_s *bank = NULL;
476
477 if ((offset & 0xf80) == 0x80) {
478 bank_no = (offset & 0x60) >> 5;
479 if (bank_no < s->nbanks) {
480 offset &= ~0x60;
481 bank = &s->bank[bank_no];
482 } else {
483 OMAP_BAD_REG(addr);
484 return;
485 }
486 }
487
488 switch (offset) {
489 case 0x10: /* INTC_SYSCONFIG */
490 s->autoidle &= 4;
491 s->autoidle |= (value & 1) << 2;
492 if (value & 2) /* SOFTRESET */
493 omap_inth_reset(&s->busdev.qdev);
494 return;
495
496 case 0x48: /* INTC_CONTROL */
497 s->mask = (value & 4) ? 0 : ~0; /* GLOBALMASK */
498 if (value & 2) { /* NEWFIQAGR */
499 qemu_set_irq(s->parent_intr[1], 0);
500 s->new_agr[1] = ~0;
501 omap_inth_update(s, 1);
502 }
503 if (value & 1) { /* NEWIRQAGR */
504 qemu_set_irq(s->parent_intr[0], 0);
505 s->new_agr[0] = ~0;
506 omap_inth_update(s, 0);
507 }
508 return;
509
510 case 0x4c: /* INTC_PROTECTION */
511 /* TODO: Make a bitmap (or sizeof(char)map) of access privileges
512 * for every register, see Chapter 3 and 4 for privileged mode. */
513 if (value & 1)
514 fprintf(stderr, "%s: protection mode enable attempt\n",
515 __FUNCTION__);
516 return;
517
518 case 0x50: /* INTC_IDLE */
519 s->autoidle &= ~3;
520 s->autoidle |= value & 3;
521 return;
522
523 /* Per-bank registers */
524 case 0x84: /* INTC_MIR */
525 bank->mask = value;
526 omap_inth_update(s, 0);
527 omap_inth_update(s, 1);
528 return;
529
530 case 0x88: /* INTC_MIR_CLEAR */
531 bank->mask &= ~value;
532 omap_inth_update(s, 0);
533 omap_inth_update(s, 1);
534 return;
535
536 case 0x8c: /* INTC_MIR_SET */
537 bank->mask |= value;
538 return;
539
540 case 0x90: /* INTC_ISR_SET */
541 bank->irqs |= bank->swi |= value;
542 omap_inth_update(s, 0);
543 omap_inth_update(s, 1);
544 return;
545
546 case 0x94: /* INTC_ISR_CLEAR */
547 bank->swi &= ~value;
548 bank->irqs = bank->swi & bank->inputs;
549 return;
550
551 /* Per-line registers */
552 case 0x100 ... 0x300: /* INTC_ILR */
553 bank_no = (offset - 0x100) >> 7;
554 if (bank_no > s->nbanks)
555 break;
556 bank = &s->bank[bank_no];
557 line_no = (offset & 0x7f) >> 2;
558 bank->priority[line_no] = (value >> 2) & 0x3f;
559 bank->fiq &= ~(1 << line_no);
560 bank->fiq |= (value & 1) << line_no;
561 return;
562
563 case 0x00: /* INTC_REVISION */
564 case 0x14: /* INTC_SYSSTATUS */
565 case 0x40: /* INTC_SIR_IRQ */
566 case 0x44: /* INTC_SIR_FIQ */
567 case 0x80: /* INTC_ITR */
568 case 0x98: /* INTC_PENDING_IRQ */
569 case 0x9c: /* INTC_PENDING_FIQ */
570 OMAP_RO_REG(addr);
571 return;
572 }
573 OMAP_BAD_REG(addr);
574 }
575
576 static const MemoryRegionOps omap2_inth_mem_ops = {
577 .read = omap2_inth_read,
578 .write = omap2_inth_write,
579 .endianness = DEVICE_NATIVE_ENDIAN,
580 .valid = {
581 .min_access_size = 4,
582 .max_access_size = 4,
583 },
584 };
585
586 static int omap2_intc_init(SysBusDevice *dev)
587 {
588 struct omap_intr_handler_s *s;
589 s = FROM_SYSBUS(struct omap_intr_handler_s, dev);
590 if (!s->iclk) {
591 hw_error("omap2-intc: iclk not connected\n");
592 }
593 if (!s->fclk) {
594 hw_error("omap2-intc: fclk not connected\n");
595 }
596 s->level_only = 1;
597 s->nbanks = 3;
598 sysbus_init_irq(dev, &s->parent_intr[0]);
599 sysbus_init_irq(dev, &s->parent_intr[1]);
600 qdev_init_gpio_in(&dev->qdev, omap_set_intr_noedge, s->nbanks * 32);
601 memory_region_init_io(&s->mmio, &omap2_inth_mem_ops, s,
602 "omap2-intc", 0x1000);
603 sysbus_init_mmio_region(dev, &s->mmio);
604 return 0;
605 }
606
607 static SysBusDeviceInfo omap2_intc_info = {
608 .init = omap2_intc_init,
609 .qdev.name = "omap2-intc",
610 .qdev.size = sizeof(struct omap_intr_handler_s),
611 .qdev.reset = omap_inth_reset,
612 .qdev.props = (Property[]) {
613 DEFINE_PROP_UINT8("revision", struct omap_intr_handler_s,
614 revision, 0x21),
615 DEFINE_PROP_PTR("iclk", struct omap_intr_handler_s, iclk),
616 DEFINE_PROP_PTR("fclk", struct omap_intr_handler_s, fclk),
617 DEFINE_PROP_END_OF_LIST()
618 }
619 };
620
621 static void omap_intc_register_device(void)
622 {
623 sysbus_register_withprop(&omap_intc_info);
624 sysbus_register_withprop(&omap2_intc_info);
625 }
626
627 device_init(omap_intc_register_device)