root / hw / pxa2xx_pic.c @ aa941b94
History | View | Annotate | Download (9.7 kB)
1 | c1713132 | balrog | /*
|
---|---|---|---|
2 | c1713132 | balrog | * Intel XScale PXA Programmable Interrupt Controller.
|
3 | c1713132 | balrog | *
|
4 | c1713132 | balrog | * Copyright (c) 2006 Openedhand Ltd.
|
5 | c1713132 | balrog | * Copyright (c) 2006 Thorsten Zitterell
|
6 | c1713132 | balrog | * Written by Andrzej Zaborowski <balrog@zabor.org>
|
7 | c1713132 | balrog | *
|
8 | c1713132 | balrog | * This code is licenced under the GPL.
|
9 | c1713132 | balrog | */
|
10 | c1713132 | balrog | |
11 | c1713132 | balrog | #include "vl.h" |
12 | c1713132 | balrog | |
13 | c1713132 | balrog | #define ICIP 0x00 /* Interrupt Controller IRQ Pending register */ |
14 | c1713132 | balrog | #define ICMR 0x04 /* Interrupt Controller Mask register */ |
15 | c1713132 | balrog | #define ICLR 0x08 /* Interrupt Controller Level register */ |
16 | c1713132 | balrog | #define ICFP 0x0c /* Interrupt Controller FIQ Pending register */ |
17 | c1713132 | balrog | #define ICPR 0x10 /* Interrupt Controller Pending register */ |
18 | c1713132 | balrog | #define ICCR 0x14 /* Interrupt Controller Control register */ |
19 | c1713132 | balrog | #define ICHP 0x18 /* Interrupt Controller Highest Priority register */ |
20 | c1713132 | balrog | #define IPR0 0x1c /* Interrupt Controller Priority register 0 */ |
21 | c1713132 | balrog | #define IPR31 0x98 /* Interrupt Controller Priority register 31 */ |
22 | c1713132 | balrog | #define ICIP2 0x9c /* Interrupt Controller IRQ Pending register 2 */ |
23 | c1713132 | balrog | #define ICMR2 0xa0 /* Interrupt Controller Mask register 2 */ |
24 | c1713132 | balrog | #define ICLR2 0xa4 /* Interrupt Controller Level register 2 */ |
25 | c1713132 | balrog | #define ICFP2 0xa8 /* Interrupt Controller FIQ Pending register 2 */ |
26 | c1713132 | balrog | #define ICPR2 0xac /* Interrupt Controller Pending register 2 */ |
27 | c1713132 | balrog | #define IPR32 0xb0 /* Interrupt Controller Priority register 32 */ |
28 | c1713132 | balrog | #define IPR39 0xcc /* Interrupt Controller Priority register 39 */ |
29 | c1713132 | balrog | |
30 | c1713132 | balrog | #define PXA2XX_PIC_SRCS 40 |
31 | c1713132 | balrog | |
32 | c1713132 | balrog | struct pxa2xx_pic_state_s {
|
33 | c1713132 | balrog | target_phys_addr_t base; |
34 | c1713132 | balrog | CPUState *cpu_env; |
35 | c1713132 | balrog | uint32_t int_enabled[2];
|
36 | c1713132 | balrog | uint32_t int_pending[2];
|
37 | c1713132 | balrog | uint32_t is_fiq[2];
|
38 | c1713132 | balrog | uint32_t int_idle; |
39 | c1713132 | balrog | uint32_t priority[PXA2XX_PIC_SRCS]; |
40 | c1713132 | balrog | }; |
41 | c1713132 | balrog | |
42 | c1713132 | balrog | static void pxa2xx_pic_update(void *opaque) |
43 | c1713132 | balrog | { |
44 | c1713132 | balrog | uint32_t mask[2];
|
45 | c1713132 | balrog | struct pxa2xx_pic_state_s *s = (struct pxa2xx_pic_state_s *) opaque; |
46 | c1713132 | balrog | |
47 | c1713132 | balrog | if (s->cpu_env->halted) {
|
48 | c1713132 | balrog | mask[0] = s->int_pending[0] & (s->int_enabled[0] | s->int_idle); |
49 | c1713132 | balrog | mask[1] = s->int_pending[1] & (s->int_enabled[1] | s->int_idle); |
50 | c1713132 | balrog | if (mask[0] || mask[1]) |
51 | c1713132 | balrog | cpu_interrupt(s->cpu_env, CPU_INTERRUPT_EXITTB); |
52 | c1713132 | balrog | } |
53 | c1713132 | balrog | |
54 | c1713132 | balrog | mask[0] = s->int_pending[0] & s->int_enabled[0]; |
55 | c1713132 | balrog | mask[1] = s->int_pending[1] & s->int_enabled[1]; |
56 | c1713132 | balrog | |
57 | c1713132 | balrog | if ((mask[0] & s->is_fiq[0]) || (mask[1] & s->is_fiq[1])) |
58 | c1713132 | balrog | cpu_interrupt(s->cpu_env, CPU_INTERRUPT_FIQ); |
59 | c1713132 | balrog | else
|
60 | c1713132 | balrog | cpu_reset_interrupt(s->cpu_env, CPU_INTERRUPT_FIQ); |
61 | c1713132 | balrog | |
62 | c1713132 | balrog | if ((mask[0] & ~s->is_fiq[0]) || (mask[1] & ~s->is_fiq[1])) |
63 | c1713132 | balrog | cpu_interrupt(s->cpu_env, CPU_INTERRUPT_HARD); |
64 | c1713132 | balrog | else
|
65 | c1713132 | balrog | cpu_reset_interrupt(s->cpu_env, CPU_INTERRUPT_HARD); |
66 | c1713132 | balrog | } |
67 | c1713132 | balrog | |
68 | c1713132 | balrog | /* Note: Here level means state of the signal on a pin, not
|
69 | c1713132 | balrog | * IRQ/FIQ distinction as in PXA Developer Manual. */
|
70 | c1713132 | balrog | static void pxa2xx_pic_set_irq(void *opaque, int irq, int level) |
71 | c1713132 | balrog | { |
72 | c1713132 | balrog | struct pxa2xx_pic_state_s *s = (struct pxa2xx_pic_state_s *) opaque; |
73 | c1713132 | balrog | int int_set = (irq >= 32); |
74 | c1713132 | balrog | irq &= 31;
|
75 | c1713132 | balrog | |
76 | c1713132 | balrog | if (level)
|
77 | c1713132 | balrog | s->int_pending[int_set] |= 1 << irq;
|
78 | c1713132 | balrog | else
|
79 | c1713132 | balrog | s->int_pending[int_set] &= ~(1 << irq);
|
80 | c1713132 | balrog | |
81 | c1713132 | balrog | pxa2xx_pic_update(opaque); |
82 | c1713132 | balrog | } |
83 | c1713132 | balrog | |
84 | c1713132 | balrog | static inline uint32_t pxa2xx_pic_highest(struct pxa2xx_pic_state_s *s) { |
85 | c1713132 | balrog | int i, int_set, irq;
|
86 | c1713132 | balrog | uint32_t bit, mask[2];
|
87 | c1713132 | balrog | uint32_t ichp = 0x003f003f; /* Both IDs invalid */ |
88 | c1713132 | balrog | |
89 | c1713132 | balrog | mask[0] = s->int_pending[0] & s->int_enabled[0]; |
90 | c1713132 | balrog | mask[1] = s->int_pending[1] & s->int_enabled[1]; |
91 | c1713132 | balrog | |
92 | c1713132 | balrog | for (i = PXA2XX_PIC_SRCS - 1; i >= 0; i --) { |
93 | c1713132 | balrog | irq = s->priority[i] & 0x3f;
|
94 | c1713132 | balrog | if ((s->priority[i] & (1 << 31)) && irq < PXA2XX_PIC_SRCS) { |
95 | c1713132 | balrog | /* Source peripheral ID is valid. */
|
96 | c1713132 | balrog | bit = 1 << (irq & 31); |
97 | c1713132 | balrog | int_set = (irq >= 32);
|
98 | c1713132 | balrog | |
99 | c1713132 | balrog | if (mask[int_set] & bit & s->is_fiq[int_set]) {
|
100 | c1713132 | balrog | /* FIQ asserted */
|
101 | c1713132 | balrog | ichp &= 0xffff0000;
|
102 | c1713132 | balrog | ichp |= (1 << 15) | irq; |
103 | c1713132 | balrog | } |
104 | c1713132 | balrog | |
105 | c1713132 | balrog | if (mask[int_set] & bit & ~s->is_fiq[int_set]) {
|
106 | c1713132 | balrog | /* IRQ asserted */
|
107 | c1713132 | balrog | ichp &= 0x0000ffff;
|
108 | c1713132 | balrog | ichp |= (1 << 31) | (irq << 16); |
109 | c1713132 | balrog | } |
110 | c1713132 | balrog | } |
111 | c1713132 | balrog | } |
112 | c1713132 | balrog | |
113 | c1713132 | balrog | return ichp;
|
114 | c1713132 | balrog | } |
115 | c1713132 | balrog | |
116 | c1713132 | balrog | static uint32_t pxa2xx_pic_mem_read(void *opaque, target_phys_addr_t offset) |
117 | c1713132 | balrog | { |
118 | c1713132 | balrog | struct pxa2xx_pic_state_s *s = (struct pxa2xx_pic_state_s *) opaque; |
119 | c1713132 | balrog | offset -= s->base; |
120 | c1713132 | balrog | |
121 | c1713132 | balrog | switch (offset) {
|
122 | c1713132 | balrog | case ICIP: /* IRQ Pending register */ |
123 | c1713132 | balrog | return s->int_pending[0] & ~s->is_fiq[0] & s->int_enabled[0]; |
124 | c1713132 | balrog | case ICIP2: /* IRQ Pending register 2 */ |
125 | c1713132 | balrog | return s->int_pending[1] & ~s->is_fiq[1] & s->int_enabled[1]; |
126 | c1713132 | balrog | case ICMR: /* Mask register */ |
127 | c1713132 | balrog | return s->int_enabled[0]; |
128 | c1713132 | balrog | case ICMR2: /* Mask register 2 */ |
129 | c1713132 | balrog | return s->int_enabled[1]; |
130 | c1713132 | balrog | case ICLR: /* Level register */ |
131 | c1713132 | balrog | return s->is_fiq[0]; |
132 | c1713132 | balrog | case ICLR2: /* Level register 2 */ |
133 | c1713132 | balrog | return s->is_fiq[1]; |
134 | c1713132 | balrog | case ICCR: /* Idle mask */ |
135 | c1713132 | balrog | return (s->int_idle == 0); |
136 | c1713132 | balrog | case ICFP: /* FIQ Pending register */ |
137 | c1713132 | balrog | return s->int_pending[0] & s->is_fiq[0] & s->int_enabled[0]; |
138 | c1713132 | balrog | case ICFP2: /* FIQ Pending register 2 */ |
139 | c1713132 | balrog | return s->int_pending[1] & s->is_fiq[1] & s->int_enabled[1]; |
140 | c1713132 | balrog | case ICPR: /* Pending register */ |
141 | c1713132 | balrog | return s->int_pending[0]; |
142 | c1713132 | balrog | case ICPR2: /* Pending register 2 */ |
143 | c1713132 | balrog | return s->int_pending[1]; |
144 | c1713132 | balrog | case IPR0 ... IPR31:
|
145 | c1713132 | balrog | return s->priority[0 + ((offset - IPR0 ) >> 2)]; |
146 | c1713132 | balrog | case IPR32 ... IPR39:
|
147 | c1713132 | balrog | return s->priority[32 + ((offset - IPR32) >> 2)]; |
148 | c1713132 | balrog | case ICHP: /* Highest Priority register */ |
149 | c1713132 | balrog | return pxa2xx_pic_highest(s);
|
150 | c1713132 | balrog | default:
|
151 | c1713132 | balrog | printf("%s: Bad register offset " REG_FMT "\n", __FUNCTION__, offset); |
152 | c1713132 | balrog | return 0; |
153 | c1713132 | balrog | } |
154 | c1713132 | balrog | } |
155 | c1713132 | balrog | |
156 | c1713132 | balrog | static void pxa2xx_pic_mem_write(void *opaque, target_phys_addr_t offset, |
157 | c1713132 | balrog | uint32_t value) |
158 | c1713132 | balrog | { |
159 | c1713132 | balrog | struct pxa2xx_pic_state_s *s = (struct pxa2xx_pic_state_s *) opaque; |
160 | c1713132 | balrog | offset -= s->base; |
161 | c1713132 | balrog | |
162 | c1713132 | balrog | switch (offset) {
|
163 | c1713132 | balrog | case ICMR: /* Mask register */ |
164 | c1713132 | balrog | s->int_enabled[0] = value;
|
165 | c1713132 | balrog | break;
|
166 | c1713132 | balrog | case ICMR2: /* Mask register 2 */ |
167 | c1713132 | balrog | s->int_enabled[1] = value;
|
168 | c1713132 | balrog | break;
|
169 | c1713132 | balrog | case ICLR: /* Level register */ |
170 | c1713132 | balrog | s->is_fiq[0] = value;
|
171 | c1713132 | balrog | break;
|
172 | c1713132 | balrog | case ICLR2: /* Level register 2 */ |
173 | c1713132 | balrog | s->is_fiq[1] = value;
|
174 | c1713132 | balrog | break;
|
175 | c1713132 | balrog | case ICCR: /* Idle mask */ |
176 | c1713132 | balrog | s->int_idle = (value & 1) ? 0 : ~0; |
177 | c1713132 | balrog | break;
|
178 | c1713132 | balrog | case IPR0 ... IPR31:
|
179 | c1713132 | balrog | s->priority[0 + ((offset - IPR0 ) >> 2)] = value & 0x8000003f; |
180 | c1713132 | balrog | break;
|
181 | c1713132 | balrog | case IPR32 ... IPR39:
|
182 | c1713132 | balrog | s->priority[32 + ((offset - IPR32) >> 2)] = value & 0x8000003f; |
183 | c1713132 | balrog | break;
|
184 | c1713132 | balrog | default:
|
185 | c1713132 | balrog | printf("%s: Bad register offset " REG_FMT "\n", __FUNCTION__, offset); |
186 | c1713132 | balrog | return;
|
187 | c1713132 | balrog | } |
188 | c1713132 | balrog | pxa2xx_pic_update(opaque); |
189 | c1713132 | balrog | } |
190 | c1713132 | balrog | |
191 | c1713132 | balrog | /* Interrupt Controller Coprocessor Space Register Mapping */
|
192 | c1713132 | balrog | static const int pxa2xx_cp_reg_map[0x10] = { |
193 | c1713132 | balrog | [0x0 ... 0xf] = -1, |
194 | c1713132 | balrog | [0x0] = ICIP,
|
195 | c1713132 | balrog | [0x1] = ICMR,
|
196 | c1713132 | balrog | [0x2] = ICLR,
|
197 | c1713132 | balrog | [0x3] = ICFP,
|
198 | c1713132 | balrog | [0x4] = ICPR,
|
199 | c1713132 | balrog | [0x5] = ICHP,
|
200 | c1713132 | balrog | [0x6] = ICIP2,
|
201 | c1713132 | balrog | [0x7] = ICMR2,
|
202 | c1713132 | balrog | [0x8] = ICLR2,
|
203 | c1713132 | balrog | [0x9] = ICFP2,
|
204 | c1713132 | balrog | [0xa] = ICPR2,
|
205 | c1713132 | balrog | }; |
206 | c1713132 | balrog | |
207 | c1713132 | balrog | static uint32_t pxa2xx_pic_cp_read(void *opaque, int op2, int reg, int crm) |
208 | c1713132 | balrog | { |
209 | c1713132 | balrog | struct pxa2xx_pic_state_s *s = (struct pxa2xx_pic_state_s *) opaque; |
210 | c1713132 | balrog | target_phys_addr_t offset; |
211 | c1713132 | balrog | |
212 | c1713132 | balrog | if (pxa2xx_cp_reg_map[reg] == -1) { |
213 | c1713132 | balrog | printf("%s: Bad register 0x%x\n", __FUNCTION__, reg);
|
214 | c1713132 | balrog | return 0; |
215 | c1713132 | balrog | } |
216 | c1713132 | balrog | |
217 | c1713132 | balrog | offset = s->base + pxa2xx_cp_reg_map[reg]; |
218 | c1713132 | balrog | return pxa2xx_pic_mem_read(opaque, offset);
|
219 | c1713132 | balrog | } |
220 | c1713132 | balrog | |
221 | c1713132 | balrog | static void pxa2xx_pic_cp_write(void *opaque, int op2, int reg, int crm, |
222 | c1713132 | balrog | uint32_t value) |
223 | c1713132 | balrog | { |
224 | c1713132 | balrog | struct pxa2xx_pic_state_s *s = (struct pxa2xx_pic_state_s *) opaque; |
225 | c1713132 | balrog | target_phys_addr_t offset; |
226 | c1713132 | balrog | |
227 | c1713132 | balrog | if (pxa2xx_cp_reg_map[reg] == -1) { |
228 | c1713132 | balrog | printf("%s: Bad register 0x%x\n", __FUNCTION__, reg);
|
229 | c1713132 | balrog | return;
|
230 | c1713132 | balrog | } |
231 | c1713132 | balrog | |
232 | c1713132 | balrog | offset = s->base + pxa2xx_cp_reg_map[reg]; |
233 | c1713132 | balrog | pxa2xx_pic_mem_write(opaque, offset, value); |
234 | c1713132 | balrog | } |
235 | c1713132 | balrog | |
236 | c1713132 | balrog | static CPUReadMemoryFunc *pxa2xx_pic_readfn[] = {
|
237 | c1713132 | balrog | pxa2xx_pic_mem_read, |
238 | c1713132 | balrog | pxa2xx_pic_mem_read, |
239 | c1713132 | balrog | pxa2xx_pic_mem_read, |
240 | c1713132 | balrog | }; |
241 | c1713132 | balrog | |
242 | c1713132 | balrog | static CPUWriteMemoryFunc *pxa2xx_pic_writefn[] = {
|
243 | c1713132 | balrog | pxa2xx_pic_mem_write, |
244 | c1713132 | balrog | pxa2xx_pic_mem_write, |
245 | c1713132 | balrog | pxa2xx_pic_mem_write, |
246 | c1713132 | balrog | }; |
247 | c1713132 | balrog | |
248 | aa941b94 | balrog | static void pxa2xx_pic_save(QEMUFile *f, void *opaque) |
249 | aa941b94 | balrog | { |
250 | aa941b94 | balrog | struct pxa2xx_pic_state_s *s = (struct pxa2xx_pic_state_s *) opaque; |
251 | aa941b94 | balrog | int i;
|
252 | aa941b94 | balrog | |
253 | aa941b94 | balrog | for (i = 0; i < 2; i ++) |
254 | aa941b94 | balrog | qemu_put_be32s(f, &s->int_enabled[i]); |
255 | aa941b94 | balrog | for (i = 0; i < 2; i ++) |
256 | aa941b94 | balrog | qemu_put_be32s(f, &s->int_pending[i]); |
257 | aa941b94 | balrog | for (i = 0; i < 2; i ++) |
258 | aa941b94 | balrog | qemu_put_be32s(f, &s->is_fiq[i]); |
259 | aa941b94 | balrog | qemu_put_be32s(f, &s->int_idle); |
260 | aa941b94 | balrog | for (i = 0; i < PXA2XX_PIC_SRCS; i ++) |
261 | aa941b94 | balrog | qemu_put_be32s(f, &s->priority[i]); |
262 | aa941b94 | balrog | } |
263 | aa941b94 | balrog | |
264 | aa941b94 | balrog | static int pxa2xx_pic_load(QEMUFile *f, void *opaque, int version_id) |
265 | aa941b94 | balrog | { |
266 | aa941b94 | balrog | struct pxa2xx_pic_state_s *s = (struct pxa2xx_pic_state_s *) opaque; |
267 | aa941b94 | balrog | int i;
|
268 | aa941b94 | balrog | |
269 | aa941b94 | balrog | for (i = 0; i < 2; i ++) |
270 | aa941b94 | balrog | qemu_get_be32s(f, &s->int_enabled[i]); |
271 | aa941b94 | balrog | for (i = 0; i < 2; i ++) |
272 | aa941b94 | balrog | qemu_get_be32s(f, &s->int_pending[i]); |
273 | aa941b94 | balrog | for (i = 0; i < 2; i ++) |
274 | aa941b94 | balrog | qemu_get_be32s(f, &s->is_fiq[i]); |
275 | aa941b94 | balrog | qemu_get_be32s(f, &s->int_idle); |
276 | aa941b94 | balrog | for (i = 0; i < PXA2XX_PIC_SRCS; i ++) |
277 | aa941b94 | balrog | qemu_get_be32s(f, &s->priority[i]); |
278 | aa941b94 | balrog | |
279 | aa941b94 | balrog | pxa2xx_pic_update(opaque); |
280 | aa941b94 | balrog | return 0; |
281 | aa941b94 | balrog | } |
282 | aa941b94 | balrog | |
283 | c1713132 | balrog | qemu_irq *pxa2xx_pic_init(target_phys_addr_t base, CPUState *env) |
284 | c1713132 | balrog | { |
285 | c1713132 | balrog | struct pxa2xx_pic_state_s *s;
|
286 | c1713132 | balrog | int iomemtype;
|
287 | c1713132 | balrog | qemu_irq *qi; |
288 | c1713132 | balrog | |
289 | c1713132 | balrog | s = (struct pxa2xx_pic_state_s *)
|
290 | c1713132 | balrog | qemu_mallocz(sizeof(struct pxa2xx_pic_state_s)); |
291 | c1713132 | balrog | if (!s)
|
292 | c1713132 | balrog | return NULL; |
293 | c1713132 | balrog | |
294 | c1713132 | balrog | s->cpu_env = env; |
295 | c1713132 | balrog | s->base = base; |
296 | c1713132 | balrog | |
297 | c1713132 | balrog | s->int_pending[0] = 0; |
298 | c1713132 | balrog | s->int_pending[1] = 0; |
299 | c1713132 | balrog | s->int_enabled[0] = 0; |
300 | c1713132 | balrog | s->int_enabled[1] = 0; |
301 | c1713132 | balrog | s->is_fiq[0] = 0; |
302 | c1713132 | balrog | s->is_fiq[1] = 0; |
303 | c1713132 | balrog | |
304 | c1713132 | balrog | qi = qemu_allocate_irqs(pxa2xx_pic_set_irq, s, PXA2XX_PIC_SRCS); |
305 | c1713132 | balrog | |
306 | c1713132 | balrog | /* Enable IC memory-mapped registers access. */
|
307 | c1713132 | balrog | iomemtype = cpu_register_io_memory(0, pxa2xx_pic_readfn,
|
308 | c1713132 | balrog | pxa2xx_pic_writefn, s); |
309 | c1713132 | balrog | cpu_register_physical_memory(base, 0x000fffff, iomemtype);
|
310 | c1713132 | balrog | |
311 | c1713132 | balrog | /* Enable IC coprocessor access. */
|
312 | c1713132 | balrog | cpu_arm_set_cp_io(env, 6, pxa2xx_pic_cp_read, pxa2xx_pic_cp_write, s);
|
313 | c1713132 | balrog | |
314 | aa941b94 | balrog | register_savevm("pxa2xx_pic", 0, 0, pxa2xx_pic_save, pxa2xx_pic_load, s); |
315 | aa941b94 | balrog | |
316 | c1713132 | balrog | return qi;
|
317 | c1713132 | balrog | } |