]> rtime.felk.cvut.cz Git - lisovros/qemu_apohw.git/blob - hw/omap_intc.c
sysbus: apic: ioapic: convert to QEMU Object Model
[lisovros/qemu_apohw.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(dev, &s->mmio);
373     return 0;
374 }
375
376 static Property omap_intc_properties[] = {
377     DEFINE_PROP_UINT32("size", struct omap_intr_handler_s, size, 0x100),
378     DEFINE_PROP_PTR("clk", struct omap_intr_handler_s, iclk),
379     DEFINE_PROP_END_OF_LIST(),
380 };
381
382 static void omap_intc_class_init(ObjectClass *klass, void *data)
383 {
384     SysBusDeviceClass *k = SYS_BUS_DEVICE_CLASS(klass);
385
386     k->init = omap_intc_init;
387 }
388
389 static DeviceInfo omap_intc_info = {
390     .name = "omap-intc",
391     .size = sizeof(struct omap_intr_handler_s),
392     .reset = omap_inth_reset,
393     .props = omap_intc_properties,
394     .class_init = omap_intc_class_init,
395 };
396
397 static uint64_t omap2_inth_read(void *opaque, target_phys_addr_t addr,
398                                 unsigned size)
399 {
400     struct omap_intr_handler_s *s = (struct omap_intr_handler_s *) opaque;
401     int offset = addr;
402     int bank_no, line_no;
403     struct omap_intr_handler_bank_s *bank = NULL;
404
405     if ((offset & 0xf80) == 0x80) {
406         bank_no = (offset & 0x60) >> 5;
407         if (bank_no < s->nbanks) {
408             offset &= ~0x60;
409             bank = &s->bank[bank_no];
410         } else {
411             OMAP_BAD_REG(addr);
412             return 0;
413         }
414     }
415
416     switch (offset) {
417     case 0x00:  /* INTC_REVISION */
418         return s->revision;
419
420     case 0x10:  /* INTC_SYSCONFIG */
421         return (s->autoidle >> 2) & 1;
422
423     case 0x14:  /* INTC_SYSSTATUS */
424         return 1;                                               /* RESETDONE */
425
426     case 0x40:  /* INTC_SIR_IRQ */
427         return s->sir_intr[0];
428
429     case 0x44:  /* INTC_SIR_FIQ */
430         return s->sir_intr[1];
431
432     case 0x48:  /* INTC_CONTROL */
433         return (!s->mask) << 2;                                 /* GLOBALMASK */
434
435     case 0x4c:  /* INTC_PROTECTION */
436         return 0;
437
438     case 0x50:  /* INTC_IDLE */
439         return s->autoidle & 3;
440
441     /* Per-bank registers */
442     case 0x80:  /* INTC_ITR */
443         return bank->inputs;
444
445     case 0x84:  /* INTC_MIR */
446         return bank->mask;
447
448     case 0x88:  /* INTC_MIR_CLEAR */
449     case 0x8c:  /* INTC_MIR_SET */
450         return 0;
451
452     case 0x90:  /* INTC_ISR_SET */
453         return bank->swi;
454
455     case 0x94:  /* INTC_ISR_CLEAR */
456         return 0;
457
458     case 0x98:  /* INTC_PENDING_IRQ */
459         return bank->irqs & ~bank->mask & ~bank->fiq;
460
461     case 0x9c:  /* INTC_PENDING_FIQ */
462         return bank->irqs & ~bank->mask & bank->fiq;
463
464     /* Per-line registers */
465     case 0x100 ... 0x300:       /* INTC_ILR */
466         bank_no = (offset - 0x100) >> 7;
467         if (bank_no > s->nbanks)
468             break;
469         bank = &s->bank[bank_no];
470         line_no = (offset & 0x7f) >> 2;
471         return (bank->priority[line_no] << 2) |
472                 ((bank->fiq >> line_no) & 1);
473     }
474     OMAP_BAD_REG(addr);
475     return 0;
476 }
477
478 static void omap2_inth_write(void *opaque, target_phys_addr_t addr,
479                              uint64_t value, unsigned size)
480 {
481     struct omap_intr_handler_s *s = (struct omap_intr_handler_s *) opaque;
482     int offset = addr;
483     int bank_no, line_no;
484     struct omap_intr_handler_bank_s *bank = NULL;
485
486     if ((offset & 0xf80) == 0x80) {
487         bank_no = (offset & 0x60) >> 5;
488         if (bank_no < s->nbanks) {
489             offset &= ~0x60;
490             bank = &s->bank[bank_no];
491         } else {
492             OMAP_BAD_REG(addr);
493             return;
494         }
495     }
496
497     switch (offset) {
498     case 0x10:  /* INTC_SYSCONFIG */
499         s->autoidle &= 4;
500         s->autoidle |= (value & 1) << 2;
501         if (value & 2)                                          /* SOFTRESET */
502             omap_inth_reset(&s->busdev.qdev);
503         return;
504
505     case 0x48:  /* INTC_CONTROL */
506         s->mask = (value & 4) ? 0 : ~0;                         /* GLOBALMASK */
507         if (value & 2) {                                        /* NEWFIQAGR */
508             qemu_set_irq(s->parent_intr[1], 0);
509             s->new_agr[1] = ~0;
510             omap_inth_update(s, 1);
511         }
512         if (value & 1) {                                        /* NEWIRQAGR */
513             qemu_set_irq(s->parent_intr[0], 0);
514             s->new_agr[0] = ~0;
515             omap_inth_update(s, 0);
516         }
517         return;
518
519     case 0x4c:  /* INTC_PROTECTION */
520         /* TODO: Make a bitmap (or sizeof(char)map) of access privileges
521          * for every register, see Chapter 3 and 4 for privileged mode.  */
522         if (value & 1)
523             fprintf(stderr, "%s: protection mode enable attempt\n",
524                             __FUNCTION__);
525         return;
526
527     case 0x50:  /* INTC_IDLE */
528         s->autoidle &= ~3;
529         s->autoidle |= value & 3;
530         return;
531
532     /* Per-bank registers */
533     case 0x84:  /* INTC_MIR */
534         bank->mask = value;
535         omap_inth_update(s, 0);
536         omap_inth_update(s, 1);
537         return;
538
539     case 0x88:  /* INTC_MIR_CLEAR */
540         bank->mask &= ~value;
541         omap_inth_update(s, 0);
542         omap_inth_update(s, 1);
543         return;
544
545     case 0x8c:  /* INTC_MIR_SET */
546         bank->mask |= value;
547         return;
548
549     case 0x90:  /* INTC_ISR_SET */
550         bank->irqs |= bank->swi |= value;
551         omap_inth_update(s, 0);
552         omap_inth_update(s, 1);
553         return;
554
555     case 0x94:  /* INTC_ISR_CLEAR */
556         bank->swi &= ~value;
557         bank->irqs = bank->swi & bank->inputs;
558         return;
559
560     /* Per-line registers */
561     case 0x100 ... 0x300:       /* INTC_ILR */
562         bank_no = (offset - 0x100) >> 7;
563         if (bank_no > s->nbanks)
564             break;
565         bank = &s->bank[bank_no];
566         line_no = (offset & 0x7f) >> 2;
567         bank->priority[line_no] = (value >> 2) & 0x3f;
568         bank->fiq &= ~(1 << line_no);
569         bank->fiq |= (value & 1) << line_no;
570         return;
571
572     case 0x00:  /* INTC_REVISION */
573     case 0x14:  /* INTC_SYSSTATUS */
574     case 0x40:  /* INTC_SIR_IRQ */
575     case 0x44:  /* INTC_SIR_FIQ */
576     case 0x80:  /* INTC_ITR */
577     case 0x98:  /* INTC_PENDING_IRQ */
578     case 0x9c:  /* INTC_PENDING_FIQ */
579         OMAP_RO_REG(addr);
580         return;
581     }
582     OMAP_BAD_REG(addr);
583 }
584
585 static const MemoryRegionOps omap2_inth_mem_ops = {
586     .read = omap2_inth_read,
587     .write = omap2_inth_write,
588     .endianness = DEVICE_NATIVE_ENDIAN,
589     .valid = {
590         .min_access_size = 4,
591         .max_access_size = 4,
592     },
593 };
594
595 static int omap2_intc_init(SysBusDevice *dev)
596 {
597     struct omap_intr_handler_s *s;
598     s = FROM_SYSBUS(struct omap_intr_handler_s, dev);
599     if (!s->iclk) {
600         hw_error("omap2-intc: iclk not connected\n");
601     }
602     if (!s->fclk) {
603         hw_error("omap2-intc: fclk not connected\n");
604     }
605     s->level_only = 1;
606     s->nbanks = 3;
607     sysbus_init_irq(dev, &s->parent_intr[0]);
608     sysbus_init_irq(dev, &s->parent_intr[1]);
609     qdev_init_gpio_in(&dev->qdev, omap_set_intr_noedge, s->nbanks * 32);
610     memory_region_init_io(&s->mmio, &omap2_inth_mem_ops, s,
611                           "omap2-intc", 0x1000);
612     sysbus_init_mmio(dev, &s->mmio);
613     return 0;
614 }
615
616 static Property omap2_intc_properties[] = {
617     DEFINE_PROP_UINT8("revision", struct omap_intr_handler_s,
618     revision, 0x21),
619     DEFINE_PROP_PTR("iclk", struct omap_intr_handler_s, iclk),
620     DEFINE_PROP_PTR("fclk", struct omap_intr_handler_s, fclk),
621     DEFINE_PROP_END_OF_LIST(),
622 };
623
624 static void omap2_intc_class_init(ObjectClass *klass, void *data)
625 {
626     SysBusDeviceClass *k = SYS_BUS_DEVICE_CLASS(klass);
627
628     k->init = omap2_intc_init;
629 }
630
631 static DeviceInfo omap2_intc_info = {
632     .name = "omap2-intc",
633     .size = sizeof(struct omap_intr_handler_s),
634     .reset = omap_inth_reset,
635     .props = omap2_intc_properties,
636     .class_init = omap2_intc_class_init,
637 };
638
639 static void omap_intc_register_device(void)
640 {
641     sysbus_register_withprop(&omap_intc_info);
642     sysbus_register_withprop(&omap2_intc_info);
643 }
644
645 device_init(omap_intc_register_device)