ARM: Factor out ARM on/off PSCI control functions
[qemu/ar7.git] / hw / timer / imx_gpt.c
blobab2e213a19074e9491bfaddd4e1889dadb10edd3
1 /*
2 * IMX GPT Timer
4 * Copyright (c) 2008 OK Labs
5 * Copyright (c) 2011 NICTA Pty Ltd
6 * Originally written by Hans Jiang
7 * Updated by Peter Chubb
8 * Updated by Jean-Christophe Dubois <jcd@tribudubois.net>
10 * This code is licensed under GPL version 2 or later. See
11 * the COPYING file in the top-level directory.
15 #include "qemu/osdep.h"
16 #include "hw/timer/imx_gpt.h"
17 #include "hw/misc/imx_ccm.h"
18 #include "qemu/main-loop.h"
20 #ifndef DEBUG_IMX_GPT
21 #define DEBUG_IMX_GPT 0
22 #endif
24 #define DPRINTF(fmt, args...) \
25 do { \
26 if (DEBUG_IMX_GPT) { \
27 fprintf(stderr, "[%s]%s: " fmt , TYPE_IMX_GPT, \
28 __func__, ##args); \
29 } \
30 } while (0)
32 static char const *imx_gpt_reg_name(uint32_t reg)
34 switch (reg) {
35 case 0:
36 return "CR";
37 case 1:
38 return "PR";
39 case 2:
40 return "SR";
41 case 3:
42 return "IR";
43 case 4:
44 return "OCR1";
45 case 5:
46 return "OCR2";
47 case 6:
48 return "OCR3";
49 case 7:
50 return "ICR1";
51 case 8:
52 return "ICR2";
53 case 9:
54 return "CNT";
55 default:
56 return "[?]";
60 static const VMStateDescription vmstate_imx_timer_gpt = {
61 .name = TYPE_IMX_GPT,
62 .version_id = 3,
63 .minimum_version_id = 3,
64 .fields = (VMStateField[]) {
65 VMSTATE_UINT32(cr, IMXGPTState),
66 VMSTATE_UINT32(pr, IMXGPTState),
67 VMSTATE_UINT32(sr, IMXGPTState),
68 VMSTATE_UINT32(ir, IMXGPTState),
69 VMSTATE_UINT32(ocr1, IMXGPTState),
70 VMSTATE_UINT32(ocr2, IMXGPTState),
71 VMSTATE_UINT32(ocr3, IMXGPTState),
72 VMSTATE_UINT32(icr1, IMXGPTState),
73 VMSTATE_UINT32(icr2, IMXGPTState),
74 VMSTATE_UINT32(cnt, IMXGPTState),
75 VMSTATE_UINT32(next_timeout, IMXGPTState),
76 VMSTATE_UINT32(next_int, IMXGPTState),
77 VMSTATE_UINT32(freq, IMXGPTState),
78 VMSTATE_PTIMER(timer, IMXGPTState),
79 VMSTATE_END_OF_LIST()
83 static const IMXClk imx_gpt_clocks[] = {
84 CLK_NONE, /* 000 No clock source */
85 CLK_IPG, /* 001 ipg_clk, 532MHz*/
86 CLK_IPG_HIGH, /* 010 ipg_clk_highfreq */
87 CLK_NONE, /* 011 not defined */
88 CLK_32k, /* 100 ipg_clk_32k */
89 CLK_NONE, /* 101 not defined */
90 CLK_NONE, /* 110 not defined */
91 CLK_NONE, /* 111 not defined */
94 static void imx_gpt_set_freq(IMXGPTState *s)
96 uint32_t clksrc = extract32(s->cr, GPT_CR_CLKSRC_SHIFT, 3);
98 s->freq = imx_ccm_get_clock_frequency(s->ccm,
99 imx_gpt_clocks[clksrc]) / (1 + s->pr);
101 DPRINTF("Setting clksrc %d to frequency %d\n", clksrc, s->freq);
103 if (s->freq) {
104 ptimer_set_freq(s->timer, s->freq);
108 static void imx_gpt_update_int(IMXGPTState *s)
110 if ((s->sr & s->ir) && (s->cr & GPT_CR_EN)) {
111 qemu_irq_raise(s->irq);
112 } else {
113 qemu_irq_lower(s->irq);
117 static uint32_t imx_gpt_update_count(IMXGPTState *s)
119 s->cnt = s->next_timeout - (uint32_t)ptimer_get_count(s->timer);
121 return s->cnt;
124 static inline uint32_t imx_gpt_find_limit(uint32_t count, uint32_t reg,
125 uint32_t timeout)
127 if ((count < reg) && (timeout > reg)) {
128 timeout = reg;
131 return timeout;
134 static void imx_gpt_compute_next_timeout(IMXGPTState *s, bool event)
136 uint32_t timeout = GPT_TIMER_MAX;
137 uint32_t count;
138 long long limit;
140 if (!(s->cr & GPT_CR_EN)) {
141 /* if not enabled just return */
142 return;
145 /* update the count */
146 count = imx_gpt_update_count(s);
148 if (event) {
150 * This is an event (the ptimer reached 0 and stopped), and the
151 * timer counter is now equal to s->next_timeout.
153 if (!(s->cr & GPT_CR_FRR) && (count == s->ocr1)) {
154 /* We are in restart mode and we crossed the compare channel 1
155 * value. We need to reset the counter to 0.
157 count = s->cnt = s->next_timeout = 0;
158 } else if (count == GPT_TIMER_MAX) {
159 /* We reached GPT_TIMER_MAX so we need to rollover */
160 count = s->cnt = s->next_timeout = 0;
164 /* now, find the next timeout related to count */
166 if (s->ir & GPT_IR_OF1IE) {
167 timeout = imx_gpt_find_limit(count, s->ocr1, timeout);
169 if (s->ir & GPT_IR_OF2IE) {
170 timeout = imx_gpt_find_limit(count, s->ocr2, timeout);
172 if (s->ir & GPT_IR_OF3IE) {
173 timeout = imx_gpt_find_limit(count, s->ocr3, timeout);
176 /* find the next set of interrupts to raise for next timer event */
178 s->next_int = 0;
179 if ((s->ir & GPT_IR_OF1IE) && (timeout == s->ocr1)) {
180 s->next_int |= GPT_SR_OF1;
182 if ((s->ir & GPT_IR_OF2IE) && (timeout == s->ocr2)) {
183 s->next_int |= GPT_SR_OF2;
185 if ((s->ir & GPT_IR_OF3IE) && (timeout == s->ocr3)) {
186 s->next_int |= GPT_SR_OF3;
188 if ((s->ir & GPT_IR_ROVIE) && (timeout == GPT_TIMER_MAX)) {
189 s->next_int |= GPT_SR_ROV;
192 /* the new range to count down from */
193 limit = timeout - imx_gpt_update_count(s);
195 if (limit < 0) {
197 * if we reach here, then QEMU is running too slow and we pass the
198 * timeout limit while computing it. Let's deliver the interrupt
199 * and compute a new limit.
201 s->sr |= s->next_int;
203 imx_gpt_compute_next_timeout(s, event);
205 imx_gpt_update_int(s);
206 } else {
207 /* New timeout value */
208 s->next_timeout = timeout;
210 /* reset the limit to the computed range */
211 ptimer_set_limit(s->timer, limit, 1);
215 static uint64_t imx_gpt_read(void *opaque, hwaddr offset, unsigned size)
217 IMXGPTState *s = IMX_GPT(opaque);
218 uint32_t reg_value = 0;
220 switch (offset >> 2) {
221 case 0: /* Control Register */
222 reg_value = s->cr;
223 break;
225 case 1: /* prescaler */
226 reg_value = s->pr;
227 break;
229 case 2: /* Status Register */
230 reg_value = s->sr;
231 break;
233 case 3: /* Interrupt Register */
234 reg_value = s->ir;
235 break;
237 case 4: /* Output Compare Register 1 */
238 reg_value = s->ocr1;
239 break;
241 case 5: /* Output Compare Register 2 */
242 reg_value = s->ocr2;
243 break;
245 case 6: /* Output Compare Register 3 */
246 reg_value = s->ocr3;
247 break;
249 case 7: /* input Capture Register 1 */
250 qemu_log_mask(LOG_UNIMP, "[%s]%s: icr1 feature is not implemented\n",
251 TYPE_IMX_GPT, __func__);
252 reg_value = s->icr1;
253 break;
255 case 8: /* input Capture Register 2 */
256 qemu_log_mask(LOG_UNIMP, "[%s]%s: icr2 feature is not implemented\n",
257 TYPE_IMX_GPT, __func__);
258 reg_value = s->icr2;
259 break;
261 case 9: /* cnt */
262 imx_gpt_update_count(s);
263 reg_value = s->cnt;
264 break;
266 default:
267 qemu_log_mask(LOG_GUEST_ERROR, "[%s]%s: Bad register at offset 0x%"
268 HWADDR_PRIx "\n", TYPE_IMX_GPT, __func__, offset);
269 break;
272 DPRINTF("(%s) = 0x%08x\n", imx_gpt_reg_name(offset >> 2), reg_value);
274 return reg_value;
277 static void imx_gpt_reset(DeviceState *dev)
279 IMXGPTState *s = IMX_GPT(dev);
281 /* stop timer */
282 ptimer_stop(s->timer);
285 * Soft reset doesn't touch some bits; hard reset clears them
287 s->cr &= ~(GPT_CR_EN|GPT_CR_ENMOD|GPT_CR_STOPEN|GPT_CR_DOZEN|
288 GPT_CR_WAITEN|GPT_CR_DBGEN);
289 s->sr = 0;
290 s->pr = 0;
291 s->ir = 0;
292 s->cnt = 0;
293 s->ocr1 = GPT_TIMER_MAX;
294 s->ocr2 = GPT_TIMER_MAX;
295 s->ocr3 = GPT_TIMER_MAX;
296 s->icr1 = 0;
297 s->icr2 = 0;
299 s->next_timeout = GPT_TIMER_MAX;
300 s->next_int = 0;
302 /* compute new freq */
303 imx_gpt_set_freq(s);
305 /* reset the limit to GPT_TIMER_MAX */
306 ptimer_set_limit(s->timer, GPT_TIMER_MAX, 1);
308 /* if the timer is still enabled, restart it */
309 if (s->freq && (s->cr & GPT_CR_EN)) {
310 ptimer_run(s->timer, 1);
314 static void imx_gpt_write(void *opaque, hwaddr offset, uint64_t value,
315 unsigned size)
317 IMXGPTState *s = IMX_GPT(opaque);
318 uint32_t oldreg;
320 DPRINTF("(%s, value = 0x%08x)\n", imx_gpt_reg_name(offset >> 2),
321 (uint32_t)value);
323 switch (offset >> 2) {
324 case 0:
325 oldreg = s->cr;
326 s->cr = value & ~0x7c14;
327 if (s->cr & GPT_CR_SWR) { /* force reset */
328 /* handle the reset */
329 imx_gpt_reset(DEVICE(s));
330 } else {
331 /* set our freq, as the source might have changed */
332 imx_gpt_set_freq(s);
334 if ((oldreg ^ s->cr) & GPT_CR_EN) {
335 if (s->cr & GPT_CR_EN) {
336 if (s->cr & GPT_CR_ENMOD) {
337 s->next_timeout = GPT_TIMER_MAX;
338 ptimer_set_count(s->timer, GPT_TIMER_MAX);
339 imx_gpt_compute_next_timeout(s, false);
341 ptimer_run(s->timer, 1);
342 } else {
343 /* stop timer */
344 ptimer_stop(s->timer);
348 break;
350 case 1: /* Prescaler */
351 s->pr = value & 0xfff;
352 imx_gpt_set_freq(s);
353 break;
355 case 2: /* SR */
356 s->sr &= ~(value & 0x3f);
357 imx_gpt_update_int(s);
358 break;
360 case 3: /* IR -- interrupt register */
361 s->ir = value & 0x3f;
362 imx_gpt_update_int(s);
364 imx_gpt_compute_next_timeout(s, false);
366 break;
368 case 4: /* OCR1 -- output compare register */
369 s->ocr1 = value;
371 /* In non-freerun mode, reset count when this register is written */
372 if (!(s->cr & GPT_CR_FRR)) {
373 s->next_timeout = GPT_TIMER_MAX;
374 ptimer_set_limit(s->timer, GPT_TIMER_MAX, 1);
377 /* compute the new timeout */
378 imx_gpt_compute_next_timeout(s, false);
380 break;
382 case 5: /* OCR2 -- output compare register */
383 s->ocr2 = value;
385 /* compute the new timeout */
386 imx_gpt_compute_next_timeout(s, false);
388 break;
390 case 6: /* OCR3 -- output compare register */
391 s->ocr3 = value;
393 /* compute the new timeout */
394 imx_gpt_compute_next_timeout(s, false);
396 break;
398 default:
399 qemu_log_mask(LOG_GUEST_ERROR, "[%s]%s: Bad register at offset 0x%"
400 HWADDR_PRIx "\n", TYPE_IMX_GPT, __func__, offset);
401 break;
405 static void imx_gpt_timeout(void *opaque)
407 IMXGPTState *s = IMX_GPT(opaque);
409 DPRINTF("\n");
411 s->sr |= s->next_int;
412 s->next_int = 0;
414 imx_gpt_compute_next_timeout(s, true);
416 imx_gpt_update_int(s);
418 if (s->freq && (s->cr & GPT_CR_EN)) {
419 ptimer_run(s->timer, 1);
423 static const MemoryRegionOps imx_gpt_ops = {
424 .read = imx_gpt_read,
425 .write = imx_gpt_write,
426 .endianness = DEVICE_NATIVE_ENDIAN,
430 static void imx_gpt_realize(DeviceState *dev, Error **errp)
432 IMXGPTState *s = IMX_GPT(dev);
433 SysBusDevice *sbd = SYS_BUS_DEVICE(dev);
434 QEMUBH *bh;
436 sysbus_init_irq(sbd, &s->irq);
437 memory_region_init_io(&s->iomem, OBJECT(s), &imx_gpt_ops, s, TYPE_IMX_GPT,
438 0x00001000);
439 sysbus_init_mmio(sbd, &s->iomem);
441 bh = qemu_bh_new(imx_gpt_timeout, s);
442 s->timer = ptimer_init(bh);
445 static void imx_gpt_class_init(ObjectClass *klass, void *data)
447 DeviceClass *dc = DEVICE_CLASS(klass);
449 dc->realize = imx_gpt_realize;
450 dc->reset = imx_gpt_reset;
451 dc->vmsd = &vmstate_imx_timer_gpt;
452 dc->desc = "i.MX general timer";
455 static const TypeInfo imx_gpt_info = {
456 .name = TYPE_IMX_GPT,
457 .parent = TYPE_SYS_BUS_DEVICE,
458 .instance_size = sizeof(IMXGPTState),
459 .class_init = imx_gpt_class_init,
462 static void imx_gpt_register_types(void)
464 type_register_static(&imx_gpt_info);
467 type_init(imx_gpt_register_types)