2 * ARM Nested Vectored Interrupt Controller
4 * Copyright (c) 2006-2007 CodeSourcery.
5 * Written by Paul Brook
7 * This code is licenced under the GPL.
9 * The ARMv7M System controller is fairly tightly tied in with the
10 * NVIC. Much of that is also implemented here.
20 /* Only a single "CPU" interface is present. */
22 gic_get_current_cpu(void)
27 static uint32_t nvic_readl(void *opaque
, uint32_t offset
);
28 static void nvic_writel(void *opaque
, uint32_t offset
, uint32_t value
);
42 /* qemu timers run at 1GHz. We want something closer to 1MHz. */
43 #define SYSTICK_SCALE 1000ULL
45 #define SYSTICK_ENABLE (1 << 0)
46 #define SYSTICK_TICKINT (1 << 1)
47 #define SYSTICK_CLKSOURCE (1 << 2)
48 #define SYSTICK_COUNTFLAG (1 << 16)
50 /* Conversion factor from qemu timer to SysTick frequencies.
51 QEMU uses a base of 1GHz, so these give 20MHz and 1MHz for core and
52 reference frequencies. */
54 static inline int64_t systick_scale(nvic_state
*s
)
56 if (s
->systick
.control
& SYSTICK_CLKSOURCE
)
62 static void systick_reload(nvic_state
*s
, int reset
)
65 s
->systick
.tick
= qemu_get_clock(vm_clock
);
66 s
->systick
.tick
+= (s
->systick
.reload
+ 1) * systick_scale(s
);
67 qemu_mod_timer(s
->systick
.timer
, s
->systick
.tick
);
70 static void systick_timer_tick(void * opaque
)
72 nvic_state
*s
= (nvic_state
*)opaque
;
73 s
->systick
.control
|= SYSTICK_COUNTFLAG
;
74 if (s
->systick
.control
& SYSTICK_TICKINT
) {
75 /* Trigger the interrupt. */
76 armv7m_nvic_set_pending(s
, ARMV7M_EXCP_SYSTICK
);
78 if (s
->systick
.reload
== 0) {
79 s
->systick
.control
&= ~SYSTICK_ENABLE
;
85 /* The external routines use the hardware vector numbering, ie. the first
86 IRQ is #16. The internal GIC routines use #32 as the first IRQ. */
87 void armv7m_nvic_set_pending(void *opaque
, int irq
)
89 nvic_state
*s
= (nvic_state
*)opaque
;
92 gic_set_pending_private(s
->gic
, 0, irq
);
95 /* Make pending IRQ active. */
96 int armv7m_nvic_acknowledge_irq(void *opaque
)
98 nvic_state
*s
= (nvic_state
*)opaque
;
101 irq
= gic_acknowledge_irq(s
->gic
, 0);
103 cpu_abort(cpu_single_env
, "Interrupt but no vector\n");
109 void armv7m_nvic_complete_irq(void *opaque
, int irq
)
111 nvic_state
*s
= (nvic_state
*)opaque
;
114 gic_complete_irq(s
->gic
, 0, irq
);
117 static uint32_t nvic_readl(void *opaque
, uint32_t offset
)
119 nvic_state
*s
= (nvic_state
*)opaque
;
124 case 4: /* Interrupt Control Type. */
125 return (GIC_NIRQ
/ 32) - 1;
126 case 0x10: /* SysTick Control and Status. */
127 val
= s
->systick
.control
;
128 s
->systick
.control
&= ~SYSTICK_COUNTFLAG
;
130 case 0x14: /* SysTick Reload Value. */
131 return s
->systick
.reload
;
132 case 0x18: /* SysTick Current Value. */
135 if ((s
->systick
.control
& SYSTICK_ENABLE
) == 0)
137 t
= qemu_get_clock(vm_clock
);
138 if (t
>= s
->systick
.tick
)
140 val
= ((s
->systick
.tick
- (t
+ 1)) / systick_scale(s
)) + 1;
141 /* The interrupt in triggered when the timer reaches zero.
142 However the counter is not reloaded until the next clock
143 tick. This is a hack to return zero during the first tick. */
144 if (val
> s
->systick
.reload
)
148 case 0x1c: /* SysTick Calibration Value. */
150 case 0xd00: /* CPUID Base. */
151 return cpu_single_env
->cp15
.c0_cpuid
;
152 case 0xd04: /* Interrypt Control State. */
154 val
= s
->gic
->running_irq
[0];
157 } else if (val
>= 32) {
161 if (s
->gic
->running_irq
[0] == 1023
162 || s
->gic
->last_active
[s
->gic
->running_irq
[0]][0] == 1023) {
166 if (s
->gic
->current_pending
[0] != 1023)
167 val
|= (s
->gic
->current_pending
[0] << 12);
169 for (irq
= 32; irq
< GIC_NIRQ
; irq
++) {
170 if (s
->gic
->irq_state
[irq
].pending
) {
176 if (s
->gic
->irq_state
[ARMV7M_EXCP_SYSTICK
].pending
)
179 if (s
->gic
->irq_state
[ARMV7M_EXCP_PENDSV
].pending
)
182 if (s
->gic
->irq_state
[ARMV7M_EXCP_NMI
].pending
)
185 case 0xd08: /* Vector Table Offset. */
186 return cpu_single_env
->v7m
.vecbase
;
187 case 0xd0c: /* Application Interrupt/Reset Control. */
189 case 0xd10: /* System Control. */
190 /* TODO: Implement SLEEPONEXIT. */
192 case 0xd14: /* Configuration Control. */
193 /* TODO: Implement Configuration Control bits. */
195 case 0xd18: case 0xd1c: case 0xd20: /* System Handler Priority. */
196 irq
= offset
- 0xd14;
198 val
= s
->gic
->priority1
[irq
++][0];
199 val
= s
->gic
->priority1
[irq
++][0] << 8;
200 val
= s
->gic
->priority1
[irq
++][0] << 16;
201 val
= s
->gic
->priority1
[irq
][0] << 24;
203 case 0xd24: /* System Handler Status. */
205 if (s
->gic
->irq_state
[ARMV7M_EXCP_MEM
].active
) val
|= (1 << 0);
206 if (s
->gic
->irq_state
[ARMV7M_EXCP_BUS
].active
) val
|= (1 << 1);
207 if (s
->gic
->irq_state
[ARMV7M_EXCP_USAGE
].active
) val
|= (1 << 3);
208 if (s
->gic
->irq_state
[ARMV7M_EXCP_SVC
].active
) val
|= (1 << 7);
209 if (s
->gic
->irq_state
[ARMV7M_EXCP_DEBUG
].active
) val
|= (1 << 8);
210 if (s
->gic
->irq_state
[ARMV7M_EXCP_PENDSV
].active
) val
|= (1 << 10);
211 if (s
->gic
->irq_state
[ARMV7M_EXCP_SYSTICK
].active
) val
|= (1 << 11);
212 if (s
->gic
->irq_state
[ARMV7M_EXCP_USAGE
].pending
) val
|= (1 << 12);
213 if (s
->gic
->irq_state
[ARMV7M_EXCP_MEM
].pending
) val
|= (1 << 13);
214 if (s
->gic
->irq_state
[ARMV7M_EXCP_BUS
].pending
) val
|= (1 << 14);
215 if (s
->gic
->irq_state
[ARMV7M_EXCP_SVC
].pending
) val
|= (1 << 15);
216 if (s
->gic
->irq_state
[ARMV7M_EXCP_MEM
].enabled
) val
|= (1 << 16);
217 if (s
->gic
->irq_state
[ARMV7M_EXCP_BUS
].enabled
) val
|= (1 << 17);
218 if (s
->gic
->irq_state
[ARMV7M_EXCP_USAGE
].enabled
) val
|= (1 << 18);
220 case 0xd28: /* Configurable Fault Status. */
221 /* TODO: Implement Fault Status. */
222 cpu_abort(cpu_single_env
,
223 "Not implemented: Configurable Fault Status.");
225 case 0xd2c: /* Hard Fault Status. */
226 case 0xd30: /* Debug Fault Status. */
227 case 0xd34: /* Mem Manage Address. */
228 case 0xd38: /* Bus Fault Address. */
229 case 0xd3c: /* Aux Fault Status. */
230 /* TODO: Implement fault status registers. */
232 case 0xd40: /* PFR0. */
234 case 0xd44: /* PRF1. */
236 case 0xd48: /* DFR0. */
238 case 0xd4c: /* AFR0. */
240 case 0xd50: /* MMFR0. */
242 case 0xd54: /* MMFR1. */
244 case 0xd58: /* MMFR2. */
246 case 0xd5c: /* MMFR3. */
248 case 0xd60: /* ISAR0. */
250 case 0xd64: /* ISAR1. */
252 case 0xd68: /* ISAR2. */
254 case 0xd6c: /* ISAR3. */
256 case 0xd70: /* ISAR4. */
258 /* TODO: Implement debug registers. */
261 cpu_abort(cpu_single_env
, "NVIC: Bad read offset 0x%x\n", offset
);
265 static void nvic_writel(void *opaque
, uint32_t offset
, uint32_t value
)
267 nvic_state
*s
= (nvic_state
*)opaque
;
270 case 0x10: /* SysTick Control and Status. */
271 oldval
= s
->systick
.control
;
272 s
->systick
.control
&= 0xfffffff8;
273 s
->systick
.control
|= value
& 7;
274 if ((oldval
^ value
) & SYSTICK_ENABLE
) {
275 int64_t now
= qemu_get_clock(vm_clock
);
276 if (value
& SYSTICK_ENABLE
) {
277 if (s
->systick
.tick
) {
278 s
->systick
.tick
+= now
;
279 qemu_mod_timer(s
->systick
.timer
, s
->systick
.tick
);
281 systick_reload(s
, 1);
284 qemu_del_timer(s
->systick
.timer
);
285 s
->systick
.tick
-= now
;
286 if (s
->systick
.tick
< 0)
289 } else if ((oldval
^ value
) & SYSTICK_CLKSOURCE
) {
290 /* This is a hack. Force the timer to be reloaded
291 when the reference clock is changed. */
292 systick_reload(s
, 1);
295 case 0x14: /* SysTick Reload Value. */
296 s
->systick
.reload
= value
;
298 case 0x18: /* SysTick Current Value. Writes reload the timer. */
299 systick_reload(s
, 1);
300 s
->systick
.control
&= ~SYSTICK_COUNTFLAG
;
302 case 0xd04: /* Interrupt Control State. */
303 if (value
& (1 << 31)) {
304 armv7m_nvic_set_pending(s
, ARMV7M_EXCP_NMI
);
306 if (value
& (1 << 28)) {
307 armv7m_nvic_set_pending(s
, ARMV7M_EXCP_PENDSV
);
308 } else if (value
& (1 << 27)) {
309 s
->gic
->irq_state
[ARMV7M_EXCP_PENDSV
].pending
= 0;
312 if (value
& (1 << 26)) {
313 armv7m_nvic_set_pending(s
, ARMV7M_EXCP_SYSTICK
);
314 } else if (value
& (1 << 25)) {
315 s
->gic
->irq_state
[ARMV7M_EXCP_SYSTICK
].pending
= 0;
319 case 0xd08: /* Vector Table Offset. */
320 cpu_single_env
->v7m
.vecbase
= value
& 0xffffff80;
322 case 0xd0c: /* Application Interrupt/Reset Control. */
323 if ((value
>> 16) == 0x05fa) {
325 cpu_abort(cpu_single_env
, "VECTCLRACTIVE not implemented");
328 cpu_abort(cpu_single_env
, "System reset");
332 case 0xd10: /* System Control. */
333 case 0xd14: /* Configuration Control. */
334 /* TODO: Implement control registers. */
336 case 0xd18: case 0xd1c: case 0xd20: /* System Handler Priority. */
339 irq
= offset
- 0xd14;
340 s
->gic
->priority1
[irq
++][0] = value
& 0xff;
341 s
->gic
->priority1
[irq
++][0] = (value
>> 8) & 0xff;
342 s
->gic
->priority1
[irq
++][0] = (value
>> 16) & 0xff;
343 s
->gic
->priority1
[irq
][0] = (value
>> 24) & 0xff;
347 case 0xd24: /* System Handler Control. */
348 /* TODO: Real hardware allows you to set/clear the active bits
349 under some circumstances. We don't implement this. */
350 s
->gic
->irq_state
[ARMV7M_EXCP_MEM
].enabled
= (value
& (1 << 16)) != 0;
351 s
->gic
->irq_state
[ARMV7M_EXCP_BUS
].enabled
= (value
& (1 << 17)) != 0;
352 s
->gic
->irq_state
[ARMV7M_EXCP_USAGE
].enabled
= (value
& (1 << 18)) != 0;
354 case 0xd28: /* Configurable Fault Status. */
355 case 0xd2c: /* Hard Fault Status. */
356 case 0xd30: /* Debug Fault Status. */
357 case 0xd34: /* Mem Manage Address. */
358 case 0xd38: /* Bus Fault Address. */
359 case 0xd3c: /* Aux Fault Status. */
363 cpu_abort(cpu_single_env
, "NVIC: Bad write offset 0x%x\n", offset
);
367 qemu_irq
*armv7m_nvic_init(CPUState
*env
)
372 parent
= arm_pic_init_cpu(env
);
373 s
= (nvic_state
*)qemu_mallocz(sizeof(nvic_state
));
374 s
->gic
= gic_init(0xe000e000, &parent
[ARM_PIC_CPU_IRQ
]);
376 s
->systick
.timer
= qemu_new_timer(vm_clock
, systick_timer_tick
, s
);
378 cpu_abort(env
, "CPU can only have one NVIC\n");