root / hw / omap_intc.c @ b8f7a738
History | View | Annotate | Download (17.2 kB)
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) |