block/nbd: fix memory leak in nbd_open()
[qemu/ar7.git] / hw / timer / pxa2xx_timer.c
blobcd172cc1e960e6a9044511048a6ca236542893e2
1 /*
2 * Intel XScale PXA255/270 OS Timers.
4 * Copyright (c) 2006 Openedhand Ltd.
5 * Copyright (c) 2006 Thorsten Zitterell
7 * This code is licensed under the GPL.
8 */
10 #include "qemu/osdep.h"
11 #include "hw/irq.h"
12 #include "hw/qdev-properties.h"
13 #include "qemu/timer.h"
14 #include "sysemu/runstate.h"
15 #include "hw/arm/pxa.h"
16 #include "hw/sysbus.h"
17 #include "migration/vmstate.h"
18 #include "qemu/log.h"
19 #include "qemu/module.h"
21 #define OSMR0 0x00
22 #define OSMR1 0x04
23 #define OSMR2 0x08
24 #define OSMR3 0x0c
25 #define OSMR4 0x80
26 #define OSMR5 0x84
27 #define OSMR6 0x88
28 #define OSMR7 0x8c
29 #define OSMR8 0x90
30 #define OSMR9 0x94
31 #define OSMR10 0x98
32 #define OSMR11 0x9c
33 #define OSCR 0x10 /* OS Timer Count */
34 #define OSCR4 0x40
35 #define OSCR5 0x44
36 #define OSCR6 0x48
37 #define OSCR7 0x4c
38 #define OSCR8 0x50
39 #define OSCR9 0x54
40 #define OSCR10 0x58
41 #define OSCR11 0x5c
42 #define OSSR 0x14 /* Timer status register */
43 #define OWER 0x18
44 #define OIER 0x1c /* Interrupt enable register 3-0 to E3-E0 */
45 #define OMCR4 0xc0 /* OS Match Control registers */
46 #define OMCR5 0xc4
47 #define OMCR6 0xc8
48 #define OMCR7 0xcc
49 #define OMCR8 0xd0
50 #define OMCR9 0xd4
51 #define OMCR10 0xd8
52 #define OMCR11 0xdc
53 #define OSNR 0x20
55 #define PXA25X_FREQ 3686400 /* 3.6864 MHz */
56 #define PXA27X_FREQ 3250000 /* 3.25 MHz */
58 static int pxa2xx_timer4_freq[8] = {
59 [0] = 0,
60 [1] = 32768,
61 [2] = 1000,
62 [3] = 1,
63 [4] = 1000000,
64 /* [5] is the "Externally supplied clock". Assign if necessary. */
65 [5 ... 7] = 0,
68 #define TYPE_PXA2XX_TIMER "pxa2xx-timer"
69 #define PXA2XX_TIMER(obj) \
70 OBJECT_CHECK(PXA2xxTimerInfo, (obj), TYPE_PXA2XX_TIMER)
72 typedef struct PXA2xxTimerInfo PXA2xxTimerInfo;
74 typedef struct {
75 uint32_t value;
76 qemu_irq irq;
77 QEMUTimer *qtimer;
78 int num;
79 PXA2xxTimerInfo *info;
80 } PXA2xxTimer0;
82 typedef struct {
83 PXA2xxTimer0 tm;
84 int32_t oldclock;
85 int32_t clock;
86 uint64_t lastload;
87 uint32_t freq;
88 uint32_t control;
89 } PXA2xxTimer4;
91 struct PXA2xxTimerInfo {
92 SysBusDevice parent_obj;
94 MemoryRegion iomem;
95 uint32_t flags;
97 int32_t clock;
98 int32_t oldclock;
99 uint64_t lastload;
100 uint32_t freq;
101 PXA2xxTimer0 timer[4];
102 uint32_t events;
103 uint32_t irq_enabled;
104 uint32_t reset3;
105 uint32_t snapshot;
107 qemu_irq irq4;
108 PXA2xxTimer4 tm4[8];
111 #define PXA2XX_TIMER_HAVE_TM4 0
113 static inline int pxa2xx_timer_has_tm4(PXA2xxTimerInfo *s)
115 return s->flags & (1 << PXA2XX_TIMER_HAVE_TM4);
118 static void pxa2xx_timer_update(void *opaque, uint64_t now_qemu)
120 PXA2xxTimerInfo *s = (PXA2xxTimerInfo *) opaque;
121 int i;
122 uint32_t now_vm;
123 uint64_t new_qemu;
125 now_vm = s->clock +
126 muldiv64(now_qemu - s->lastload, s->freq, NANOSECONDS_PER_SECOND);
128 for (i = 0; i < 4; i ++) {
129 new_qemu = now_qemu + muldiv64((uint32_t) (s->timer[i].value - now_vm),
130 NANOSECONDS_PER_SECOND, s->freq);
131 timer_mod(s->timer[i].qtimer, new_qemu);
135 static void pxa2xx_timer_update4(void *opaque, uint64_t now_qemu, int n)
137 PXA2xxTimerInfo *s = (PXA2xxTimerInfo *) opaque;
138 uint32_t now_vm;
139 uint64_t new_qemu;
140 static const int counters[8] = { 0, 0, 0, 0, 4, 4, 6, 6 };
141 int counter;
143 if (s->tm4[n].control & (1 << 7))
144 counter = n;
145 else
146 counter = counters[n];
148 if (!s->tm4[counter].freq) {
149 timer_del(s->tm4[n].tm.qtimer);
150 return;
153 now_vm = s->tm4[counter].clock + muldiv64(now_qemu -
154 s->tm4[counter].lastload,
155 s->tm4[counter].freq, NANOSECONDS_PER_SECOND);
157 new_qemu = now_qemu + muldiv64((uint32_t) (s->tm4[n].tm.value - now_vm),
158 NANOSECONDS_PER_SECOND, s->tm4[counter].freq);
159 timer_mod(s->tm4[n].tm.qtimer, new_qemu);
162 static uint64_t pxa2xx_timer_read(void *opaque, hwaddr offset,
163 unsigned size)
165 PXA2xxTimerInfo *s = (PXA2xxTimerInfo *) opaque;
166 int tm = 0;
168 switch (offset) {
169 case OSMR3: tm ++;
170 /* fall through */
171 case OSMR2: tm ++;
172 /* fall through */
173 case OSMR1: tm ++;
174 /* fall through */
175 case OSMR0:
176 return s->timer[tm].value;
177 case OSMR11: tm ++;
178 /* fall through */
179 case OSMR10: tm ++;
180 /* fall through */
181 case OSMR9: tm ++;
182 /* fall through */
183 case OSMR8: tm ++;
184 /* fall through */
185 case OSMR7: tm ++;
186 /* fall through */
187 case OSMR6: tm ++;
188 /* fall through */
189 case OSMR5: tm ++;
190 /* fall through */
191 case OSMR4:
192 if (!pxa2xx_timer_has_tm4(s))
193 goto badreg;
194 return s->tm4[tm].tm.value;
195 case OSCR:
196 return s->clock + muldiv64(qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL) -
197 s->lastload, s->freq, NANOSECONDS_PER_SECOND);
198 case OSCR11: tm ++;
199 /* fall through */
200 case OSCR10: tm ++;
201 /* fall through */
202 case OSCR9: tm ++;
203 /* fall through */
204 case OSCR8: tm ++;
205 /* fall through */
206 case OSCR7: tm ++;
207 /* fall through */
208 case OSCR6: tm ++;
209 /* fall through */
210 case OSCR5: tm ++;
211 /* fall through */
212 case OSCR4:
213 if (!pxa2xx_timer_has_tm4(s))
214 goto badreg;
216 if ((tm == 9 - 4 || tm == 11 - 4) && (s->tm4[tm].control & (1 << 9))) {
217 if (s->tm4[tm - 1].freq)
218 s->snapshot = s->tm4[tm - 1].clock + muldiv64(
219 qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL) -
220 s->tm4[tm - 1].lastload,
221 s->tm4[tm - 1].freq, NANOSECONDS_PER_SECOND);
222 else
223 s->snapshot = s->tm4[tm - 1].clock;
226 if (!s->tm4[tm].freq)
227 return s->tm4[tm].clock;
228 return s->tm4[tm].clock +
229 muldiv64(qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL) -
230 s->tm4[tm].lastload, s->tm4[tm].freq,
231 NANOSECONDS_PER_SECOND);
232 case OIER:
233 return s->irq_enabled;
234 case OSSR: /* Status register */
235 return s->events;
236 case OWER:
237 return s->reset3;
238 case OMCR11: tm ++;
239 /* fall through */
240 case OMCR10: tm ++;
241 /* fall through */
242 case OMCR9: tm ++;
243 /* fall through */
244 case OMCR8: tm ++;
245 /* fall through */
246 case OMCR7: tm ++;
247 /* fall through */
248 case OMCR6: tm ++;
249 /* fall through */
250 case OMCR5: tm ++;
251 /* fall through */
252 case OMCR4:
253 if (!pxa2xx_timer_has_tm4(s))
254 goto badreg;
255 return s->tm4[tm].control;
256 case OSNR:
257 return s->snapshot;
258 default:
259 qemu_log_mask(LOG_UNIMP,
260 "%s: unknown register 0x%02" HWADDR_PRIx "\n",
261 __func__, offset);
262 break;
263 badreg:
264 qemu_log_mask(LOG_GUEST_ERROR,
265 "%s: incorrect register 0x%02" HWADDR_PRIx "\n",
266 __func__, offset);
269 return 0;
272 static void pxa2xx_timer_write(void *opaque, hwaddr offset,
273 uint64_t value, unsigned size)
275 int i, tm = 0;
276 PXA2xxTimerInfo *s = (PXA2xxTimerInfo *) opaque;
278 switch (offset) {
279 case OSMR3: tm ++;
280 /* fall through */
281 case OSMR2: tm ++;
282 /* fall through */
283 case OSMR1: tm ++;
284 /* fall through */
285 case OSMR0:
286 s->timer[tm].value = value;
287 pxa2xx_timer_update(s, qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL));
288 break;
289 case OSMR11: tm ++;
290 /* fall through */
291 case OSMR10: tm ++;
292 /* fall through */
293 case OSMR9: tm ++;
294 /* fall through */
295 case OSMR8: tm ++;
296 /* fall through */
297 case OSMR7: tm ++;
298 /* fall through */
299 case OSMR6: tm ++;
300 /* fall through */
301 case OSMR5: tm ++;
302 /* fall through */
303 case OSMR4:
304 if (!pxa2xx_timer_has_tm4(s))
305 goto badreg;
306 s->tm4[tm].tm.value = value;
307 pxa2xx_timer_update4(s, qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL), tm);
308 break;
309 case OSCR:
310 s->oldclock = s->clock;
311 s->lastload = qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL);
312 s->clock = value;
313 pxa2xx_timer_update(s, s->lastload);
314 break;
315 case OSCR11: tm ++;
316 /* fall through */
317 case OSCR10: tm ++;
318 /* fall through */
319 case OSCR9: tm ++;
320 /* fall through */
321 case OSCR8: tm ++;
322 /* fall through */
323 case OSCR7: tm ++;
324 /* fall through */
325 case OSCR6: tm ++;
326 /* fall through */
327 case OSCR5: tm ++;
328 /* fall through */
329 case OSCR4:
330 if (!pxa2xx_timer_has_tm4(s))
331 goto badreg;
332 s->tm4[tm].oldclock = s->tm4[tm].clock;
333 s->tm4[tm].lastload = qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL);
334 s->tm4[tm].clock = value;
335 pxa2xx_timer_update4(s, s->tm4[tm].lastload, tm);
336 break;
337 case OIER:
338 s->irq_enabled = value & 0xfff;
339 break;
340 case OSSR: /* Status register */
341 value &= s->events;
342 s->events &= ~value;
343 for (i = 0; i < 4; i ++, value >>= 1)
344 if (value & 1)
345 qemu_irq_lower(s->timer[i].irq);
346 if (pxa2xx_timer_has_tm4(s) && !(s->events & 0xff0) && value)
347 qemu_irq_lower(s->irq4);
348 break;
349 case OWER: /* XXX: Reset on OSMR3 match? */
350 s->reset3 = value;
351 break;
352 case OMCR7: tm ++;
353 /* fall through */
354 case OMCR6: tm ++;
355 /* fall through */
356 case OMCR5: tm ++;
357 /* fall through */
358 case OMCR4:
359 if (!pxa2xx_timer_has_tm4(s))
360 goto badreg;
361 s->tm4[tm].control = value & 0x0ff;
362 /* XXX Stop if running (shouldn't happen) */
363 if ((value & (1 << 7)) || tm == 0)
364 s->tm4[tm].freq = pxa2xx_timer4_freq[value & 7];
365 else {
366 s->tm4[tm].freq = 0;
367 pxa2xx_timer_update4(s, qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL), tm);
369 break;
370 case OMCR11: tm ++;
371 /* fall through */
372 case OMCR10: tm ++;
373 /* fall through */
374 case OMCR9: tm ++;
375 /* fall through */
376 case OMCR8: tm += 4;
377 if (!pxa2xx_timer_has_tm4(s))
378 goto badreg;
379 s->tm4[tm].control = value & 0x3ff;
380 /* XXX Stop if running (shouldn't happen) */
381 if ((value & (1 << 7)) || !(tm & 1))
382 s->tm4[tm].freq =
383 pxa2xx_timer4_freq[(value & (1 << 8)) ? 0 : (value & 7)];
384 else {
385 s->tm4[tm].freq = 0;
386 pxa2xx_timer_update4(s, qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL), tm);
388 break;
389 default:
390 qemu_log_mask(LOG_UNIMP,
391 "%s: unknown register 0x%02" HWADDR_PRIx " "
392 "(value 0x%08" PRIx64 ")\n", __func__, offset, value);
393 break;
394 badreg:
395 qemu_log_mask(LOG_GUEST_ERROR,
396 "%s: incorrect register 0x%02" HWADDR_PRIx " "
397 "(value 0x%08" PRIx64 ")\n", __func__, offset, value);
401 static const MemoryRegionOps pxa2xx_timer_ops = {
402 .read = pxa2xx_timer_read,
403 .write = pxa2xx_timer_write,
404 .endianness = DEVICE_NATIVE_ENDIAN,
407 static void pxa2xx_timer_tick(void *opaque)
409 PXA2xxTimer0 *t = (PXA2xxTimer0 *) opaque;
410 PXA2xxTimerInfo *i = t->info;
412 if (i->irq_enabled & (1 << t->num)) {
413 i->events |= 1 << t->num;
414 qemu_irq_raise(t->irq);
417 if (t->num == 3)
418 if (i->reset3 & 1) {
419 i->reset3 = 0;
420 qemu_system_reset_request(SHUTDOWN_CAUSE_GUEST_RESET);
424 static void pxa2xx_timer_tick4(void *opaque)
426 PXA2xxTimer4 *t = (PXA2xxTimer4 *) opaque;
427 PXA2xxTimerInfo *i = (PXA2xxTimerInfo *) t->tm.info;
429 pxa2xx_timer_tick(&t->tm);
430 if (t->control & (1 << 3))
431 t->clock = 0;
432 if (t->control & (1 << 6))
433 pxa2xx_timer_update4(i, qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL), t->tm.num - 4);
434 if (i->events & 0xff0)
435 qemu_irq_raise(i->irq4);
438 static int pxa25x_timer_post_load(void *opaque, int version_id)
440 PXA2xxTimerInfo *s = (PXA2xxTimerInfo *) opaque;
441 int64_t now;
442 int i;
444 now = qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL);
445 pxa2xx_timer_update(s, now);
447 if (pxa2xx_timer_has_tm4(s))
448 for (i = 0; i < 8; i ++)
449 pxa2xx_timer_update4(s, now, i);
451 return 0;
454 static void pxa2xx_timer_init(Object *obj)
456 PXA2xxTimerInfo *s = PXA2XX_TIMER(obj);
457 SysBusDevice *dev = SYS_BUS_DEVICE(obj);
459 s->irq_enabled = 0;
460 s->oldclock = 0;
461 s->clock = 0;
462 s->lastload = qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL);
463 s->reset3 = 0;
465 memory_region_init_io(&s->iomem, obj, &pxa2xx_timer_ops, s,
466 "pxa2xx-timer", 0x00001000);
467 sysbus_init_mmio(dev, &s->iomem);
470 static void pxa2xx_timer_realize(DeviceState *dev, Error **errp)
472 PXA2xxTimerInfo *s = PXA2XX_TIMER(dev);
473 SysBusDevice *sbd = SYS_BUS_DEVICE(dev);
474 int i;
476 for (i = 0; i < 4; i ++) {
477 s->timer[i].value = 0;
478 sysbus_init_irq(sbd, &s->timer[i].irq);
479 s->timer[i].info = s;
480 s->timer[i].num = i;
481 s->timer[i].qtimer = timer_new_ns(QEMU_CLOCK_VIRTUAL,
482 pxa2xx_timer_tick, &s->timer[i]);
485 if (s->flags & (1 << PXA2XX_TIMER_HAVE_TM4)) {
486 sysbus_init_irq(sbd, &s->irq4);
488 for (i = 0; i < 8; i ++) {
489 s->tm4[i].tm.value = 0;
490 s->tm4[i].tm.info = s;
491 s->tm4[i].tm.num = i + 4;
492 s->tm4[i].freq = 0;
493 s->tm4[i].control = 0x0;
494 s->tm4[i].tm.qtimer = timer_new_ns(QEMU_CLOCK_VIRTUAL,
495 pxa2xx_timer_tick4, &s->tm4[i]);
500 static const VMStateDescription vmstate_pxa2xx_timer0_regs = {
501 .name = "pxa2xx_timer0",
502 .version_id = 2,
503 .minimum_version_id = 2,
504 .fields = (VMStateField[]) {
505 VMSTATE_UINT32(value, PXA2xxTimer0),
506 VMSTATE_END_OF_LIST(),
510 static const VMStateDescription vmstate_pxa2xx_timer4_regs = {
511 .name = "pxa2xx_timer4",
512 .version_id = 1,
513 .minimum_version_id = 1,
514 .fields = (VMStateField[]) {
515 VMSTATE_STRUCT(tm, PXA2xxTimer4, 1,
516 vmstate_pxa2xx_timer0_regs, PXA2xxTimer0),
517 VMSTATE_INT32(oldclock, PXA2xxTimer4),
518 VMSTATE_INT32(clock, PXA2xxTimer4),
519 VMSTATE_UINT64(lastload, PXA2xxTimer4),
520 VMSTATE_UINT32(freq, PXA2xxTimer4),
521 VMSTATE_UINT32(control, PXA2xxTimer4),
522 VMSTATE_END_OF_LIST(),
526 static bool pxa2xx_timer_has_tm4_test(void *opaque, int version_id)
528 return pxa2xx_timer_has_tm4(opaque);
531 static const VMStateDescription vmstate_pxa2xx_timer_regs = {
532 .name = "pxa2xx_timer",
533 .version_id = 1,
534 .minimum_version_id = 1,
535 .post_load = pxa25x_timer_post_load,
536 .fields = (VMStateField[]) {
537 VMSTATE_INT32(clock, PXA2xxTimerInfo),
538 VMSTATE_INT32(oldclock, PXA2xxTimerInfo),
539 VMSTATE_UINT64(lastload, PXA2xxTimerInfo),
540 VMSTATE_STRUCT_ARRAY(timer, PXA2xxTimerInfo, 4, 1,
541 vmstate_pxa2xx_timer0_regs, PXA2xxTimer0),
542 VMSTATE_UINT32(events, PXA2xxTimerInfo),
543 VMSTATE_UINT32(irq_enabled, PXA2xxTimerInfo),
544 VMSTATE_UINT32(reset3, PXA2xxTimerInfo),
545 VMSTATE_UINT32(snapshot, PXA2xxTimerInfo),
546 VMSTATE_STRUCT_ARRAY_TEST(tm4, PXA2xxTimerInfo, 8,
547 pxa2xx_timer_has_tm4_test, 0,
548 vmstate_pxa2xx_timer4_regs, PXA2xxTimer4),
549 VMSTATE_END_OF_LIST(),
553 static Property pxa25x_timer_dev_properties[] = {
554 DEFINE_PROP_UINT32("freq", PXA2xxTimerInfo, freq, PXA25X_FREQ),
555 DEFINE_PROP_BIT("tm4", PXA2xxTimerInfo, flags,
556 PXA2XX_TIMER_HAVE_TM4, false),
557 DEFINE_PROP_END_OF_LIST(),
560 static void pxa25x_timer_dev_class_init(ObjectClass *klass, void *data)
562 DeviceClass *dc = DEVICE_CLASS(klass);
564 dc->desc = "PXA25x timer";
565 device_class_set_props(dc, pxa25x_timer_dev_properties);
568 static const TypeInfo pxa25x_timer_dev_info = {
569 .name = "pxa25x-timer",
570 .parent = TYPE_PXA2XX_TIMER,
571 .instance_size = sizeof(PXA2xxTimerInfo),
572 .class_init = pxa25x_timer_dev_class_init,
575 static Property pxa27x_timer_dev_properties[] = {
576 DEFINE_PROP_UINT32("freq", PXA2xxTimerInfo, freq, PXA27X_FREQ),
577 DEFINE_PROP_BIT("tm4", PXA2xxTimerInfo, flags,
578 PXA2XX_TIMER_HAVE_TM4, true),
579 DEFINE_PROP_END_OF_LIST(),
582 static void pxa27x_timer_dev_class_init(ObjectClass *klass, void *data)
584 DeviceClass *dc = DEVICE_CLASS(klass);
586 dc->desc = "PXA27x timer";
587 device_class_set_props(dc, pxa27x_timer_dev_properties);
590 static const TypeInfo pxa27x_timer_dev_info = {
591 .name = "pxa27x-timer",
592 .parent = TYPE_PXA2XX_TIMER,
593 .instance_size = sizeof(PXA2xxTimerInfo),
594 .class_init = pxa27x_timer_dev_class_init,
597 static void pxa2xx_timer_class_init(ObjectClass *oc, void *data)
599 DeviceClass *dc = DEVICE_CLASS(oc);
601 dc->realize = pxa2xx_timer_realize;
602 dc->vmsd = &vmstate_pxa2xx_timer_regs;
605 static const TypeInfo pxa2xx_timer_type_info = {
606 .name = TYPE_PXA2XX_TIMER,
607 .parent = TYPE_SYS_BUS_DEVICE,
608 .instance_size = sizeof(PXA2xxTimerInfo),
609 .instance_init = pxa2xx_timer_init,
610 .abstract = true,
611 .class_init = pxa2xx_timer_class_init,
614 static void pxa2xx_timer_register_types(void)
616 type_register_static(&pxa2xx_timer_type_info);
617 type_register_static(&pxa25x_timer_dev_info);
618 type_register_static(&pxa27x_timer_dev_info);
621 type_init(pxa2xx_timer_register_types)