xref: /qemu/hw/timer/pxa2xx_timer.c (revision 2ba63e4af69b674f4fabd317dd438061de1ea310)
1a171fe39Sbalrog /*
2a171fe39Sbalrog  * Intel XScale PXA255/270 OS Timers.
3a171fe39Sbalrog  *
4a171fe39Sbalrog  * Copyright (c) 2006 Openedhand Ltd.
5a171fe39Sbalrog  * Copyright (c) 2006 Thorsten Zitterell
6a171fe39Sbalrog  *
78e31bf38SMatthew Fernandez  * This code is licensed under the GPL.
8a171fe39Sbalrog  */
9a171fe39Sbalrog 
108ef94f0bSPeter Maydell #include "qemu/osdep.h"
1183c9f4caSPaolo Bonzini #include "hw/hw.h"
121de7afc9SPaolo Bonzini #include "qemu/timer.h"
139c17d615SPaolo Bonzini #include "sysemu/sysemu.h"
140d09e41aSPaolo Bonzini #include "hw/arm/pxa.h"
1583c9f4caSPaolo Bonzini #include "hw/sysbus.h"
16*2ba63e4aSPhilippe Mathieu-Daudé #include "qemu/log.h"
17a171fe39Sbalrog 
18a171fe39Sbalrog #define OSMR0	0x00
19a171fe39Sbalrog #define OSMR1	0x04
20a171fe39Sbalrog #define OSMR2	0x08
21a171fe39Sbalrog #define OSMR3	0x0c
22a171fe39Sbalrog #define OSMR4	0x80
23a171fe39Sbalrog #define OSMR5	0x84
24a171fe39Sbalrog #define OSMR6	0x88
25a171fe39Sbalrog #define OSMR7	0x8c
26a171fe39Sbalrog #define OSMR8	0x90
27a171fe39Sbalrog #define OSMR9	0x94
28a171fe39Sbalrog #define OSMR10	0x98
29a171fe39Sbalrog #define OSMR11	0x9c
30a171fe39Sbalrog #define OSCR	0x10	/* OS Timer Count */
31a171fe39Sbalrog #define OSCR4	0x40
32a171fe39Sbalrog #define OSCR5	0x44
33a171fe39Sbalrog #define OSCR6	0x48
34a171fe39Sbalrog #define OSCR7	0x4c
35a171fe39Sbalrog #define OSCR8	0x50
36a171fe39Sbalrog #define OSCR9	0x54
37a171fe39Sbalrog #define OSCR10	0x58
38a171fe39Sbalrog #define OSCR11	0x5c
39a171fe39Sbalrog #define OSSR	0x14	/* Timer status register */
40a171fe39Sbalrog #define OWER	0x18
41a171fe39Sbalrog #define OIER	0x1c	/* Interrupt enable register  3-0 to E3-E0 */
42a171fe39Sbalrog #define OMCR4	0xc0	/* OS Match Control registers */
43a171fe39Sbalrog #define OMCR5	0xc4
44a171fe39Sbalrog #define OMCR6	0xc8
45a171fe39Sbalrog #define OMCR7	0xcc
46a171fe39Sbalrog #define OMCR8	0xd0
47a171fe39Sbalrog #define OMCR9	0xd4
48a171fe39Sbalrog #define OMCR10	0xd8
49a171fe39Sbalrog #define OMCR11	0xdc
50a171fe39Sbalrog #define OSNR	0x20
51a171fe39Sbalrog 
52a171fe39Sbalrog #define PXA25X_FREQ	3686400	/* 3.6864 MHz */
53a171fe39Sbalrog #define PXA27X_FREQ	3250000	/* 3.25 MHz */
54a171fe39Sbalrog 
55a171fe39Sbalrog static int pxa2xx_timer4_freq[8] = {
56a171fe39Sbalrog     [0] = 0,
57a171fe39Sbalrog     [1] = 32768,
58a171fe39Sbalrog     [2] = 1000,
59a171fe39Sbalrog     [3] = 1,
60a171fe39Sbalrog     [4] = 1000000,
61a171fe39Sbalrog     /* [5] is the "Externally supplied clock".  Assign if necessary.  */
62a171fe39Sbalrog     [5 ... 7] = 0,
63a171fe39Sbalrog };
64a171fe39Sbalrog 
65feea4361SAndreas Färber #define TYPE_PXA2XX_TIMER "pxa2xx-timer"
66feea4361SAndreas Färber #define PXA2XX_TIMER(obj) \
67feea4361SAndreas Färber     OBJECT_CHECK(PXA2xxTimerInfo, (obj), TYPE_PXA2XX_TIMER)
68feea4361SAndreas Färber 
69797e9542SDmitry Eremin-Solenikov typedef struct PXA2xxTimerInfo PXA2xxTimerInfo;
70797e9542SDmitry Eremin-Solenikov 
71bc24a225SPaul Brook typedef struct {
72a171fe39Sbalrog     uint32_t value;
735251d196SAndrzej Zaborowski     qemu_irq irq;
74a171fe39Sbalrog     QEMUTimer *qtimer;
75a171fe39Sbalrog     int num;
76797e9542SDmitry Eremin-Solenikov     PXA2xxTimerInfo *info;
77bc24a225SPaul Brook } PXA2xxTimer0;
78a171fe39Sbalrog 
79bc24a225SPaul Brook typedef struct {
80bc24a225SPaul Brook     PXA2xxTimer0 tm;
81a171fe39Sbalrog     int32_t oldclock;
82a171fe39Sbalrog     int32_t clock;
83a171fe39Sbalrog     uint64_t lastload;
84a171fe39Sbalrog     uint32_t freq;
85a171fe39Sbalrog     uint32_t control;
86bc24a225SPaul Brook } PXA2xxTimer4;
87a171fe39Sbalrog 
88797e9542SDmitry Eremin-Solenikov struct PXA2xxTimerInfo {
89feea4361SAndreas Färber     SysBusDevice parent_obj;
90feea4361SAndreas Färber 
91b755bde3SBenoît Canet     MemoryRegion iomem;
92797e9542SDmitry Eremin-Solenikov     uint32_t flags;
93797e9542SDmitry Eremin-Solenikov 
94a171fe39Sbalrog     int32_t clock;
95a171fe39Sbalrog     int32_t oldclock;
96a171fe39Sbalrog     uint64_t lastload;
97a171fe39Sbalrog     uint32_t freq;
98bc24a225SPaul Brook     PXA2xxTimer0 timer[4];
99a171fe39Sbalrog     uint32_t events;
100a171fe39Sbalrog     uint32_t irq_enabled;
101a171fe39Sbalrog     uint32_t reset3;
102a171fe39Sbalrog     uint32_t snapshot;
103797e9542SDmitry Eremin-Solenikov 
1044ff927ccSDmitry Eremin-Solenikov     qemu_irq irq4;
105797e9542SDmitry Eremin-Solenikov     PXA2xxTimer4 tm4[8];
106797e9542SDmitry Eremin-Solenikov };
107797e9542SDmitry Eremin-Solenikov 
108797e9542SDmitry Eremin-Solenikov #define PXA2XX_TIMER_HAVE_TM4	0
109797e9542SDmitry Eremin-Solenikov 
110797e9542SDmitry Eremin-Solenikov static inline int pxa2xx_timer_has_tm4(PXA2xxTimerInfo *s)
111797e9542SDmitry Eremin-Solenikov {
112797e9542SDmitry Eremin-Solenikov     return s->flags & (1 << PXA2XX_TIMER_HAVE_TM4);
113797e9542SDmitry Eremin-Solenikov }
114a171fe39Sbalrog 
115a171fe39Sbalrog static void pxa2xx_timer_update(void *opaque, uint64_t now_qemu)
116a171fe39Sbalrog {
117d353eb43SDmitry Eremin-Solenikov     PXA2xxTimerInfo *s = (PXA2xxTimerInfo *) opaque;
118a171fe39Sbalrog     int i;
119a171fe39Sbalrog     uint32_t now_vm;
120a171fe39Sbalrog     uint64_t new_qemu;
121a171fe39Sbalrog 
122a171fe39Sbalrog     now_vm = s->clock +
12373bcb24dSRutuja Shah             muldiv64(now_qemu - s->lastload, s->freq, NANOSECONDS_PER_SECOND);
124a171fe39Sbalrog 
125a171fe39Sbalrog     for (i = 0; i < 4; i ++) {
126a171fe39Sbalrog         new_qemu = now_qemu + muldiv64((uint32_t) (s->timer[i].value - now_vm),
12773bcb24dSRutuja Shah                         NANOSECONDS_PER_SECOND, s->freq);
128bc72ad67SAlex Bligh         timer_mod(s->timer[i].qtimer, new_qemu);
129a171fe39Sbalrog     }
130a171fe39Sbalrog }
131a171fe39Sbalrog 
132a171fe39Sbalrog static void pxa2xx_timer_update4(void *opaque, uint64_t now_qemu, int n)
133a171fe39Sbalrog {
134d353eb43SDmitry Eremin-Solenikov     PXA2xxTimerInfo *s = (PXA2xxTimerInfo *) opaque;
135a171fe39Sbalrog     uint32_t now_vm;
136a171fe39Sbalrog     uint64_t new_qemu;
137a171fe39Sbalrog     static const int counters[8] = { 0, 0, 0, 0, 4, 4, 6, 6 };
138a171fe39Sbalrog     int counter;
139a171fe39Sbalrog 
140a171fe39Sbalrog     if (s->tm4[n].control & (1 << 7))
141a171fe39Sbalrog         counter = n;
142a171fe39Sbalrog     else
143a171fe39Sbalrog         counter = counters[n];
144a171fe39Sbalrog 
145a171fe39Sbalrog     if (!s->tm4[counter].freq) {
146bc72ad67SAlex Bligh         timer_del(s->tm4[n].tm.qtimer);
147a171fe39Sbalrog         return;
148a171fe39Sbalrog     }
149a171fe39Sbalrog 
150a171fe39Sbalrog     now_vm = s->tm4[counter].clock + muldiv64(now_qemu -
151a171fe39Sbalrog                     s->tm4[counter].lastload,
15273bcb24dSRutuja Shah                     s->tm4[counter].freq, NANOSECONDS_PER_SECOND);
153a171fe39Sbalrog 
1543bdd58a4Sbalrog     new_qemu = now_qemu + muldiv64((uint32_t) (s->tm4[n].tm.value - now_vm),
15573bcb24dSRutuja Shah                     NANOSECONDS_PER_SECOND, s->tm4[counter].freq);
156bc72ad67SAlex Bligh     timer_mod(s->tm4[n].tm.qtimer, new_qemu);
157a171fe39Sbalrog }
158a171fe39Sbalrog 
159a8170e5eSAvi Kivity static uint64_t pxa2xx_timer_read(void *opaque, hwaddr offset,
160b755bde3SBenoît Canet                                   unsigned size)
161a171fe39Sbalrog {
162d353eb43SDmitry Eremin-Solenikov     PXA2xxTimerInfo *s = (PXA2xxTimerInfo *) opaque;
163a171fe39Sbalrog     int tm = 0;
164a171fe39Sbalrog 
165a171fe39Sbalrog     switch (offset) {
166a171fe39Sbalrog     case OSMR3:  tm ++;
167de16017dSPeter Maydell         /* fall through */
168a171fe39Sbalrog     case OSMR2:  tm ++;
169de16017dSPeter Maydell         /* fall through */
170a171fe39Sbalrog     case OSMR1:  tm ++;
171de16017dSPeter Maydell         /* fall through */
172a171fe39Sbalrog     case OSMR0:
173a171fe39Sbalrog         return s->timer[tm].value;
174a171fe39Sbalrog     case OSMR11: tm ++;
175de16017dSPeter Maydell         /* fall through */
176a171fe39Sbalrog     case OSMR10: tm ++;
177de16017dSPeter Maydell         /* fall through */
178a171fe39Sbalrog     case OSMR9:  tm ++;
179de16017dSPeter Maydell         /* fall through */
180a171fe39Sbalrog     case OSMR8:  tm ++;
181de16017dSPeter Maydell         /* fall through */
182a171fe39Sbalrog     case OSMR7:  tm ++;
183de16017dSPeter Maydell         /* fall through */
184a171fe39Sbalrog     case OSMR6:  tm ++;
185de16017dSPeter Maydell         /* fall through */
186a171fe39Sbalrog     case OSMR5:  tm ++;
187de16017dSPeter Maydell         /* fall through */
188a171fe39Sbalrog     case OSMR4:
189797e9542SDmitry Eremin-Solenikov         if (!pxa2xx_timer_has_tm4(s))
190a171fe39Sbalrog             goto badreg;
1913bdd58a4Sbalrog         return s->tm4[tm].tm.value;
192a171fe39Sbalrog     case OSCR:
193bc72ad67SAlex Bligh         return s->clock + muldiv64(qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL) -
19473bcb24dSRutuja Shah                         s->lastload, s->freq, NANOSECONDS_PER_SECOND);
195a171fe39Sbalrog     case OSCR11: tm ++;
196de16017dSPeter Maydell         /* fall through */
197a171fe39Sbalrog     case OSCR10: tm ++;
198de16017dSPeter Maydell         /* fall through */
199a171fe39Sbalrog     case OSCR9:  tm ++;
200de16017dSPeter Maydell         /* fall through */
201a171fe39Sbalrog     case OSCR8:  tm ++;
202de16017dSPeter Maydell         /* fall through */
203a171fe39Sbalrog     case OSCR7:  tm ++;
204de16017dSPeter Maydell         /* fall through */
205a171fe39Sbalrog     case OSCR6:  tm ++;
206de16017dSPeter Maydell         /* fall through */
207a171fe39Sbalrog     case OSCR5:  tm ++;
208de16017dSPeter Maydell         /* fall through */
209a171fe39Sbalrog     case OSCR4:
210797e9542SDmitry Eremin-Solenikov         if (!pxa2xx_timer_has_tm4(s))
211a171fe39Sbalrog             goto badreg;
212a171fe39Sbalrog 
213a171fe39Sbalrog         if ((tm == 9 - 4 || tm == 11 - 4) && (s->tm4[tm].control & (1 << 9))) {
214a171fe39Sbalrog             if (s->tm4[tm - 1].freq)
215a171fe39Sbalrog                 s->snapshot = s->tm4[tm - 1].clock + muldiv64(
216bc72ad67SAlex Bligh                                 qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL) -
217a171fe39Sbalrog                                 s->tm4[tm - 1].lastload,
21873bcb24dSRutuja Shah                                 s->tm4[tm - 1].freq, NANOSECONDS_PER_SECOND);
219a171fe39Sbalrog             else
220a171fe39Sbalrog                 s->snapshot = s->tm4[tm - 1].clock;
221a171fe39Sbalrog         }
222a171fe39Sbalrog 
223a171fe39Sbalrog         if (!s->tm4[tm].freq)
224a171fe39Sbalrog             return s->tm4[tm].clock;
22573bcb24dSRutuja Shah         return s->tm4[tm].clock +
22673bcb24dSRutuja Shah             muldiv64(qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL) -
22773bcb24dSRutuja Shah                      s->tm4[tm].lastload, s->tm4[tm].freq,
22873bcb24dSRutuja Shah                      NANOSECONDS_PER_SECOND);
229a171fe39Sbalrog     case OIER:
230a171fe39Sbalrog         return s->irq_enabled;
231a171fe39Sbalrog     case OSSR:	/* Status register */
232a171fe39Sbalrog         return s->events;
233a171fe39Sbalrog     case OWER:
234a171fe39Sbalrog         return s->reset3;
235a171fe39Sbalrog     case OMCR11: tm ++;
236de16017dSPeter Maydell         /* fall through */
237a171fe39Sbalrog     case OMCR10: tm ++;
238de16017dSPeter Maydell         /* fall through */
239a171fe39Sbalrog     case OMCR9:  tm ++;
240de16017dSPeter Maydell         /* fall through */
241a171fe39Sbalrog     case OMCR8:  tm ++;
242de16017dSPeter Maydell         /* fall through */
243a171fe39Sbalrog     case OMCR7:  tm ++;
244de16017dSPeter Maydell         /* fall through */
245a171fe39Sbalrog     case OMCR6:  tm ++;
246de16017dSPeter Maydell         /* fall through */
247a171fe39Sbalrog     case OMCR5:  tm ++;
248de16017dSPeter Maydell         /* fall through */
249a171fe39Sbalrog     case OMCR4:
250797e9542SDmitry Eremin-Solenikov         if (!pxa2xx_timer_has_tm4(s))
251a171fe39Sbalrog             goto badreg;
252a171fe39Sbalrog         return s->tm4[tm].control;
253a171fe39Sbalrog     case OSNR:
254a171fe39Sbalrog         return s->snapshot;
255a171fe39Sbalrog     default:
256*2ba63e4aSPhilippe Mathieu-Daudé         qemu_log_mask(LOG_UNIMP,
257*2ba63e4aSPhilippe Mathieu-Daudé                       "%s: unknown register 0x%02" HWADDR_PRIx "\n",
258*2ba63e4aSPhilippe Mathieu-Daudé                       __func__, offset);
259*2ba63e4aSPhilippe Mathieu-Daudé         break;
260a171fe39Sbalrog     badreg:
261*2ba63e4aSPhilippe Mathieu-Daudé         qemu_log_mask(LOG_GUEST_ERROR,
262*2ba63e4aSPhilippe Mathieu-Daudé                       "%s: incorrect register 0x%02" HWADDR_PRIx "\n",
263*2ba63e4aSPhilippe Mathieu-Daudé                       __func__, offset);
264a171fe39Sbalrog     }
265a171fe39Sbalrog 
266a171fe39Sbalrog     return 0;
267a171fe39Sbalrog }
268a171fe39Sbalrog 
269a8170e5eSAvi Kivity static void pxa2xx_timer_write(void *opaque, hwaddr offset,
270b755bde3SBenoît Canet                                uint64_t value, unsigned size)
271a171fe39Sbalrog {
272a171fe39Sbalrog     int i, tm = 0;
273d353eb43SDmitry Eremin-Solenikov     PXA2xxTimerInfo *s = (PXA2xxTimerInfo *) opaque;
274a171fe39Sbalrog 
275a171fe39Sbalrog     switch (offset) {
276a171fe39Sbalrog     case OSMR3:  tm ++;
277de16017dSPeter Maydell         /* fall through */
278a171fe39Sbalrog     case OSMR2:  tm ++;
279de16017dSPeter Maydell         /* fall through */
280a171fe39Sbalrog     case OSMR1:  tm ++;
281de16017dSPeter Maydell         /* fall through */
282a171fe39Sbalrog     case OSMR0:
283a171fe39Sbalrog         s->timer[tm].value = value;
284bc72ad67SAlex Bligh         pxa2xx_timer_update(s, qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL));
285a171fe39Sbalrog         break;
286a171fe39Sbalrog     case OSMR11: tm ++;
287de16017dSPeter Maydell         /* fall through */
288a171fe39Sbalrog     case OSMR10: tm ++;
289de16017dSPeter Maydell         /* fall through */
290a171fe39Sbalrog     case OSMR9:  tm ++;
291de16017dSPeter Maydell         /* fall through */
292a171fe39Sbalrog     case OSMR8:  tm ++;
293de16017dSPeter Maydell         /* fall through */
294a171fe39Sbalrog     case OSMR7:  tm ++;
295de16017dSPeter Maydell         /* fall through */
296a171fe39Sbalrog     case OSMR6:  tm ++;
297de16017dSPeter Maydell         /* fall through */
298a171fe39Sbalrog     case OSMR5:  tm ++;
299de16017dSPeter Maydell         /* fall through */
300a171fe39Sbalrog     case OSMR4:
301797e9542SDmitry Eremin-Solenikov         if (!pxa2xx_timer_has_tm4(s))
302a171fe39Sbalrog             goto badreg;
3033bdd58a4Sbalrog         s->tm4[tm].tm.value = value;
304bc72ad67SAlex Bligh         pxa2xx_timer_update4(s, qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL), tm);
305a171fe39Sbalrog         break;
306a171fe39Sbalrog     case OSCR:
307a171fe39Sbalrog         s->oldclock = s->clock;
308bc72ad67SAlex Bligh         s->lastload = qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL);
309a171fe39Sbalrog         s->clock = value;
310a171fe39Sbalrog         pxa2xx_timer_update(s, s->lastload);
311a171fe39Sbalrog         break;
312a171fe39Sbalrog     case OSCR11: tm ++;
313de16017dSPeter Maydell         /* fall through */
314a171fe39Sbalrog     case OSCR10: tm ++;
315de16017dSPeter Maydell         /* fall through */
316a171fe39Sbalrog     case OSCR9:  tm ++;
317de16017dSPeter Maydell         /* fall through */
318a171fe39Sbalrog     case OSCR8:  tm ++;
319de16017dSPeter Maydell         /* fall through */
320a171fe39Sbalrog     case OSCR7:  tm ++;
321de16017dSPeter Maydell         /* fall through */
322a171fe39Sbalrog     case OSCR6:  tm ++;
323de16017dSPeter Maydell         /* fall through */
324a171fe39Sbalrog     case OSCR5:  tm ++;
325de16017dSPeter Maydell         /* fall through */
326a171fe39Sbalrog     case OSCR4:
327797e9542SDmitry Eremin-Solenikov         if (!pxa2xx_timer_has_tm4(s))
328a171fe39Sbalrog             goto badreg;
329a171fe39Sbalrog         s->tm4[tm].oldclock = s->tm4[tm].clock;
330bc72ad67SAlex Bligh         s->tm4[tm].lastload = qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL);
331a171fe39Sbalrog         s->tm4[tm].clock = value;
332a171fe39Sbalrog         pxa2xx_timer_update4(s, s->tm4[tm].lastload, tm);
333a171fe39Sbalrog         break;
334a171fe39Sbalrog     case OIER:
335a171fe39Sbalrog         s->irq_enabled = value & 0xfff;
336a171fe39Sbalrog         break;
337a171fe39Sbalrog     case OSSR:	/* Status register */
3388034ce7dSAndrzej Zaborowski         value &= s->events;
339a171fe39Sbalrog         s->events &= ~value;
3408034ce7dSAndrzej Zaborowski         for (i = 0; i < 4; i ++, value >>= 1)
3418034ce7dSAndrzej Zaborowski             if (value & 1)
3425251d196SAndrzej Zaborowski                 qemu_irq_lower(s->timer[i].irq);
3438034ce7dSAndrzej Zaborowski         if (pxa2xx_timer_has_tm4(s) && !(s->events & 0xff0) && value)
3444ff927ccSDmitry Eremin-Solenikov             qemu_irq_lower(s->irq4);
345a171fe39Sbalrog         break;
346a171fe39Sbalrog     case OWER:	/* XXX: Reset on OSMR3 match? */
347a171fe39Sbalrog         s->reset3 = value;
348a171fe39Sbalrog         break;
349a171fe39Sbalrog     case OMCR7:  tm ++;
350de16017dSPeter Maydell         /* fall through */
351a171fe39Sbalrog     case OMCR6:  tm ++;
352de16017dSPeter Maydell         /* fall through */
353a171fe39Sbalrog     case OMCR5:  tm ++;
354de16017dSPeter Maydell         /* fall through */
355a171fe39Sbalrog     case OMCR4:
356797e9542SDmitry Eremin-Solenikov         if (!pxa2xx_timer_has_tm4(s))
357a171fe39Sbalrog             goto badreg;
358a171fe39Sbalrog         s->tm4[tm].control = value & 0x0ff;
359a171fe39Sbalrog         /* XXX Stop if running (shouldn't happen) */
360a171fe39Sbalrog         if ((value & (1 << 7)) || tm == 0)
361a171fe39Sbalrog             s->tm4[tm].freq = pxa2xx_timer4_freq[value & 7];
362a171fe39Sbalrog         else {
363a171fe39Sbalrog             s->tm4[tm].freq = 0;
364bc72ad67SAlex Bligh             pxa2xx_timer_update4(s, qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL), tm);
365a171fe39Sbalrog         }
366a171fe39Sbalrog         break;
367a171fe39Sbalrog     case OMCR11: tm ++;
368de16017dSPeter Maydell         /* fall through */
369a171fe39Sbalrog     case OMCR10: tm ++;
370de16017dSPeter Maydell         /* fall through */
371a171fe39Sbalrog     case OMCR9:  tm ++;
372de16017dSPeter Maydell         /* fall through */
373a171fe39Sbalrog     case OMCR8:  tm += 4;
374797e9542SDmitry Eremin-Solenikov         if (!pxa2xx_timer_has_tm4(s))
375a171fe39Sbalrog             goto badreg;
376a171fe39Sbalrog         s->tm4[tm].control = value & 0x3ff;
377a171fe39Sbalrog         /* XXX Stop if running (shouldn't happen) */
378a171fe39Sbalrog         if ((value & (1 << 7)) || !(tm & 1))
379a171fe39Sbalrog             s->tm4[tm].freq =
380a171fe39Sbalrog                     pxa2xx_timer4_freq[(value & (1 << 8)) ?  0 : (value & 7)];
381a171fe39Sbalrog         else {
382a171fe39Sbalrog             s->tm4[tm].freq = 0;
383bc72ad67SAlex Bligh             pxa2xx_timer_update4(s, qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL), tm);
384a171fe39Sbalrog         }
385a171fe39Sbalrog         break;
386a171fe39Sbalrog     default:
387*2ba63e4aSPhilippe Mathieu-Daudé         qemu_log_mask(LOG_UNIMP,
388*2ba63e4aSPhilippe Mathieu-Daudé                       "%s: unknown register 0x%02" HWADDR_PRIx " "
389*2ba63e4aSPhilippe Mathieu-Daudé                       "(value 0x%08" PRIx64 ")\n",  __func__, offset, value);
390*2ba63e4aSPhilippe Mathieu-Daudé         break;
391a171fe39Sbalrog     badreg:
392*2ba63e4aSPhilippe Mathieu-Daudé         qemu_log_mask(LOG_GUEST_ERROR,
393*2ba63e4aSPhilippe Mathieu-Daudé                       "%s: incorrect register 0x%02" HWADDR_PRIx " "
394*2ba63e4aSPhilippe Mathieu-Daudé                       "(value 0x%08" PRIx64 ")\n", __func__, offset, value);
395a171fe39Sbalrog     }
396a171fe39Sbalrog }
397a171fe39Sbalrog 
398b755bde3SBenoît Canet static const MemoryRegionOps pxa2xx_timer_ops = {
399b755bde3SBenoît Canet     .read = pxa2xx_timer_read,
400b755bde3SBenoît Canet     .write = pxa2xx_timer_write,
401b755bde3SBenoît Canet     .endianness = DEVICE_NATIVE_ENDIAN,
402a171fe39Sbalrog };
403a171fe39Sbalrog 
404a171fe39Sbalrog static void pxa2xx_timer_tick(void *opaque)
405a171fe39Sbalrog {
406bc24a225SPaul Brook     PXA2xxTimer0 *t = (PXA2xxTimer0 *) opaque;
407797e9542SDmitry Eremin-Solenikov     PXA2xxTimerInfo *i = t->info;
408a171fe39Sbalrog 
409a171fe39Sbalrog     if (i->irq_enabled & (1 << t->num)) {
410a171fe39Sbalrog         i->events |= 1 << t->num;
4115251d196SAndrzej Zaborowski         qemu_irq_raise(t->irq);
412a171fe39Sbalrog     }
413a171fe39Sbalrog 
414a171fe39Sbalrog     if (t->num == 3)
415a171fe39Sbalrog         if (i->reset3 & 1) {
416a171fe39Sbalrog             i->reset3 = 0;
417cf83f140SEric Blake             qemu_system_reset_request(SHUTDOWN_CAUSE_GUEST_RESET);
418a171fe39Sbalrog         }
419a171fe39Sbalrog }
420a171fe39Sbalrog 
421a171fe39Sbalrog static void pxa2xx_timer_tick4(void *opaque)
422a171fe39Sbalrog {
423bc24a225SPaul Brook     PXA2xxTimer4 *t = (PXA2xxTimer4 *) opaque;
424d353eb43SDmitry Eremin-Solenikov     PXA2xxTimerInfo *i = (PXA2xxTimerInfo *) t->tm.info;
425a171fe39Sbalrog 
4263bdd58a4Sbalrog     pxa2xx_timer_tick(&t->tm);
427a171fe39Sbalrog     if (t->control & (1 << 3))
428a171fe39Sbalrog         t->clock = 0;
429a171fe39Sbalrog     if (t->control & (1 << 6))
430bc72ad67SAlex Bligh         pxa2xx_timer_update4(i, qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL), t->tm.num - 4);
4314ff927ccSDmitry Eremin-Solenikov     if (i->events & 0xff0)
4324ff927ccSDmitry Eremin-Solenikov         qemu_irq_raise(i->irq4);
433a171fe39Sbalrog }
434a171fe39Sbalrog 
435797e9542SDmitry Eremin-Solenikov static int pxa25x_timer_post_load(void *opaque, int version_id)
436aa941b94Sbalrog {
437d353eb43SDmitry Eremin-Solenikov     PXA2xxTimerInfo *s = (PXA2xxTimerInfo *) opaque;
438aa941b94Sbalrog     int64_t now;
439aa941b94Sbalrog     int i;
440aa941b94Sbalrog 
441bc72ad67SAlex Bligh     now = qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL);
442aa941b94Sbalrog     pxa2xx_timer_update(s, now);
443aa941b94Sbalrog 
444797e9542SDmitry Eremin-Solenikov     if (pxa2xx_timer_has_tm4(s))
445797e9542SDmitry Eremin-Solenikov         for (i = 0; i < 8; i ++)
446aa941b94Sbalrog             pxa2xx_timer_update4(s, now, i);
447aa941b94Sbalrog 
448aa941b94Sbalrog     return 0;
449aa941b94Sbalrog }
450aa941b94Sbalrog 
4515d83e348Sxiaoqiang.zhao static void pxa2xx_timer_init(Object *obj)
452a171fe39Sbalrog {
4535d83e348Sxiaoqiang.zhao     PXA2xxTimerInfo *s = PXA2XX_TIMER(obj);
4545d83e348Sxiaoqiang.zhao     SysBusDevice *dev = SYS_BUS_DEVICE(obj);
455a171fe39Sbalrog 
456a171fe39Sbalrog     s->irq_enabled = 0;
457a171fe39Sbalrog     s->oldclock = 0;
458a171fe39Sbalrog     s->clock = 0;
459bc72ad67SAlex Bligh     s->lastload = qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL);
460a171fe39Sbalrog     s->reset3 = 0;
461a171fe39Sbalrog 
4625d83e348Sxiaoqiang.zhao     memory_region_init_io(&s->iomem, obj, &pxa2xx_timer_ops, s,
4635d83e348Sxiaoqiang.zhao                           "pxa2xx-timer", 0x00001000);
4645d83e348Sxiaoqiang.zhao     sysbus_init_mmio(dev, &s->iomem);
4655d83e348Sxiaoqiang.zhao }
4665d83e348Sxiaoqiang.zhao 
4675d83e348Sxiaoqiang.zhao static void pxa2xx_timer_realize(DeviceState *dev, Error **errp)
4685d83e348Sxiaoqiang.zhao {
4695d83e348Sxiaoqiang.zhao     PXA2xxTimerInfo *s = PXA2XX_TIMER(dev);
4705d83e348Sxiaoqiang.zhao     SysBusDevice *sbd = SYS_BUS_DEVICE(dev);
4715d83e348Sxiaoqiang.zhao     int i;
4725d83e348Sxiaoqiang.zhao 
473a171fe39Sbalrog     for (i = 0; i < 4; i ++) {
474a171fe39Sbalrog         s->timer[i].value = 0;
4755d83e348Sxiaoqiang.zhao         sysbus_init_irq(sbd, &s->timer[i].irq);
476a171fe39Sbalrog         s->timer[i].info = s;
477a171fe39Sbalrog         s->timer[i].num = i;
478bc72ad67SAlex Bligh         s->timer[i].qtimer = timer_new_ns(QEMU_CLOCK_VIRTUAL,
479a171fe39Sbalrog                                           pxa2xx_timer_tick, &s->timer[i]);
480a171fe39Sbalrog     }
4815d83e348Sxiaoqiang.zhao 
482797e9542SDmitry Eremin-Solenikov     if (s->flags & (1 << PXA2XX_TIMER_HAVE_TM4)) {
4835d83e348Sxiaoqiang.zhao         sysbus_init_irq(sbd, &s->irq4);
484a171fe39Sbalrog 
485a171fe39Sbalrog         for (i = 0; i < 8; i ++) {
4863bdd58a4Sbalrog             s->tm4[i].tm.value = 0;
4873bdd58a4Sbalrog             s->tm4[i].tm.info = s;
4883bdd58a4Sbalrog             s->tm4[i].tm.num = i + 4;
489a171fe39Sbalrog             s->tm4[i].freq = 0;
490a171fe39Sbalrog             s->tm4[i].control = 0x0;
491bc72ad67SAlex Bligh             s->tm4[i].tm.qtimer = timer_new_ns(QEMU_CLOCK_VIRTUAL,
492a171fe39Sbalrog                                                pxa2xx_timer_tick4, &s->tm4[i]);
493a171fe39Sbalrog         }
494a171fe39Sbalrog     }
495797e9542SDmitry Eremin-Solenikov }
496797e9542SDmitry Eremin-Solenikov 
497797e9542SDmitry Eremin-Solenikov static const VMStateDescription vmstate_pxa2xx_timer0_regs = {
498797e9542SDmitry Eremin-Solenikov     .name = "pxa2xx_timer0",
4998034ce7dSAndrzej Zaborowski     .version_id = 2,
5008034ce7dSAndrzej Zaborowski     .minimum_version_id = 2,
501797e9542SDmitry Eremin-Solenikov     .fields = (VMStateField[]) {
502797e9542SDmitry Eremin-Solenikov         VMSTATE_UINT32(value, PXA2xxTimer0),
503797e9542SDmitry Eremin-Solenikov         VMSTATE_END_OF_LIST(),
504797e9542SDmitry Eremin-Solenikov     },
505797e9542SDmitry Eremin-Solenikov };
506797e9542SDmitry Eremin-Solenikov 
507797e9542SDmitry Eremin-Solenikov static const VMStateDescription vmstate_pxa2xx_timer4_regs = {
508797e9542SDmitry Eremin-Solenikov     .name = "pxa2xx_timer4",
509797e9542SDmitry Eremin-Solenikov     .version_id = 1,
510797e9542SDmitry Eremin-Solenikov     .minimum_version_id = 1,
511797e9542SDmitry Eremin-Solenikov     .fields = (VMStateField[]) {
512797e9542SDmitry Eremin-Solenikov         VMSTATE_STRUCT(tm, PXA2xxTimer4, 1,
513797e9542SDmitry Eremin-Solenikov                         vmstate_pxa2xx_timer0_regs, PXA2xxTimer0),
514797e9542SDmitry Eremin-Solenikov         VMSTATE_INT32(oldclock, PXA2xxTimer4),
515797e9542SDmitry Eremin-Solenikov         VMSTATE_INT32(clock, PXA2xxTimer4),
516797e9542SDmitry Eremin-Solenikov         VMSTATE_UINT64(lastload, PXA2xxTimer4),
517797e9542SDmitry Eremin-Solenikov         VMSTATE_UINT32(freq, PXA2xxTimer4),
518797e9542SDmitry Eremin-Solenikov         VMSTATE_UINT32(control, PXA2xxTimer4),
519797e9542SDmitry Eremin-Solenikov         VMSTATE_END_OF_LIST(),
520797e9542SDmitry Eremin-Solenikov     },
521797e9542SDmitry Eremin-Solenikov };
522797e9542SDmitry Eremin-Solenikov 
523797e9542SDmitry Eremin-Solenikov static bool pxa2xx_timer_has_tm4_test(void *opaque, int version_id)
524797e9542SDmitry Eremin-Solenikov {
525797e9542SDmitry Eremin-Solenikov     return pxa2xx_timer_has_tm4(opaque);
526797e9542SDmitry Eremin-Solenikov }
527797e9542SDmitry Eremin-Solenikov 
528797e9542SDmitry Eremin-Solenikov static const VMStateDescription vmstate_pxa2xx_timer_regs = {
529797e9542SDmitry Eremin-Solenikov     .name = "pxa2xx_timer",
530797e9542SDmitry Eremin-Solenikov     .version_id = 1,
531797e9542SDmitry Eremin-Solenikov     .minimum_version_id = 1,
532797e9542SDmitry Eremin-Solenikov     .post_load = pxa25x_timer_post_load,
533797e9542SDmitry Eremin-Solenikov     .fields = (VMStateField[]) {
534797e9542SDmitry Eremin-Solenikov         VMSTATE_INT32(clock, PXA2xxTimerInfo),
535797e9542SDmitry Eremin-Solenikov         VMSTATE_INT32(oldclock, PXA2xxTimerInfo),
536797e9542SDmitry Eremin-Solenikov         VMSTATE_UINT64(lastload, PXA2xxTimerInfo),
537797e9542SDmitry Eremin-Solenikov         VMSTATE_STRUCT_ARRAY(timer, PXA2xxTimerInfo, 4, 1,
538797e9542SDmitry Eremin-Solenikov                         vmstate_pxa2xx_timer0_regs, PXA2xxTimer0),
539797e9542SDmitry Eremin-Solenikov         VMSTATE_UINT32(events, PXA2xxTimerInfo),
540797e9542SDmitry Eremin-Solenikov         VMSTATE_UINT32(irq_enabled, PXA2xxTimerInfo),
541797e9542SDmitry Eremin-Solenikov         VMSTATE_UINT32(reset3, PXA2xxTimerInfo),
542797e9542SDmitry Eremin-Solenikov         VMSTATE_UINT32(snapshot, PXA2xxTimerInfo),
543797e9542SDmitry Eremin-Solenikov         VMSTATE_STRUCT_ARRAY_TEST(tm4, PXA2xxTimerInfo, 8,
544797e9542SDmitry Eremin-Solenikov                         pxa2xx_timer_has_tm4_test, 0,
545797e9542SDmitry Eremin-Solenikov                         vmstate_pxa2xx_timer4_regs, PXA2xxTimer4),
546797e9542SDmitry Eremin-Solenikov         VMSTATE_END_OF_LIST(),
547797e9542SDmitry Eremin-Solenikov     }
548797e9542SDmitry Eremin-Solenikov };
549797e9542SDmitry Eremin-Solenikov 
550999e12bbSAnthony Liguori static Property pxa25x_timer_dev_properties[] = {
551797e9542SDmitry Eremin-Solenikov     DEFINE_PROP_UINT32("freq", PXA2xxTimerInfo, freq, PXA25X_FREQ),
552797e9542SDmitry Eremin-Solenikov     DEFINE_PROP_BIT("tm4", PXA2xxTimerInfo, flags,
553797e9542SDmitry Eremin-Solenikov                     PXA2XX_TIMER_HAVE_TM4, false),
554797e9542SDmitry Eremin-Solenikov     DEFINE_PROP_END_OF_LIST(),
555797e9542SDmitry Eremin-Solenikov };
556797e9542SDmitry Eremin-Solenikov 
557999e12bbSAnthony Liguori static void pxa25x_timer_dev_class_init(ObjectClass *klass, void *data)
558999e12bbSAnthony Liguori {
55939bffca2SAnthony Liguori     DeviceClass *dc = DEVICE_CLASS(klass);
560999e12bbSAnthony Liguori 
56139bffca2SAnthony Liguori     dc->desc = "PXA25x timer";
56239bffca2SAnthony Liguori     dc->props = pxa25x_timer_dev_properties;
563999e12bbSAnthony Liguori }
564999e12bbSAnthony Liguori 
5658c43a6f0SAndreas Färber static const TypeInfo pxa25x_timer_dev_info = {
566999e12bbSAnthony Liguori     .name          = "pxa25x-timer",
567feea4361SAndreas Färber     .parent        = TYPE_PXA2XX_TIMER,
56839bffca2SAnthony Liguori     .instance_size = sizeof(PXA2xxTimerInfo),
569999e12bbSAnthony Liguori     .class_init    = pxa25x_timer_dev_class_init,
570999e12bbSAnthony Liguori };
571999e12bbSAnthony Liguori 
572999e12bbSAnthony Liguori static Property pxa27x_timer_dev_properties[] = {
573797e9542SDmitry Eremin-Solenikov     DEFINE_PROP_UINT32("freq", PXA2xxTimerInfo, freq, PXA27X_FREQ),
574797e9542SDmitry Eremin-Solenikov     DEFINE_PROP_BIT("tm4", PXA2xxTimerInfo, flags,
575797e9542SDmitry Eremin-Solenikov                     PXA2XX_TIMER_HAVE_TM4, true),
576797e9542SDmitry Eremin-Solenikov     DEFINE_PROP_END_OF_LIST(),
577999e12bbSAnthony Liguori };
578999e12bbSAnthony Liguori 
579999e12bbSAnthony Liguori static void pxa27x_timer_dev_class_init(ObjectClass *klass, void *data)
580999e12bbSAnthony Liguori {
58139bffca2SAnthony Liguori     DeviceClass *dc = DEVICE_CLASS(klass);
582999e12bbSAnthony Liguori 
58339bffca2SAnthony Liguori     dc->desc = "PXA27x timer";
58439bffca2SAnthony Liguori     dc->props = pxa27x_timer_dev_properties;
585999e12bbSAnthony Liguori }
586999e12bbSAnthony Liguori 
5878c43a6f0SAndreas Färber static const TypeInfo pxa27x_timer_dev_info = {
588999e12bbSAnthony Liguori     .name          = "pxa27x-timer",
589feea4361SAndreas Färber     .parent        = TYPE_PXA2XX_TIMER,
59039bffca2SAnthony Liguori     .instance_size = sizeof(PXA2xxTimerInfo),
591999e12bbSAnthony Liguori     .class_init    = pxa27x_timer_dev_class_init,
592797e9542SDmitry Eremin-Solenikov };
593797e9542SDmitry Eremin-Solenikov 
594feea4361SAndreas Färber static void pxa2xx_timer_class_init(ObjectClass *oc, void *data)
595feea4361SAndreas Färber {
596feea4361SAndreas Färber     DeviceClass *dc = DEVICE_CLASS(oc);
597feea4361SAndreas Färber 
5985d83e348Sxiaoqiang.zhao     dc->realize  = pxa2xx_timer_realize;
599feea4361SAndreas Färber     dc->vmsd = &vmstate_pxa2xx_timer_regs;
600feea4361SAndreas Färber }
601feea4361SAndreas Färber 
602feea4361SAndreas Färber static const TypeInfo pxa2xx_timer_type_info = {
603feea4361SAndreas Färber     .name          = TYPE_PXA2XX_TIMER,
604feea4361SAndreas Färber     .parent        = TYPE_SYS_BUS_DEVICE,
605feea4361SAndreas Färber     .instance_size = sizeof(PXA2xxTimerInfo),
6065d83e348Sxiaoqiang.zhao     .instance_init = pxa2xx_timer_init,
607feea4361SAndreas Färber     .abstract      = true,
608feea4361SAndreas Färber     .class_init    = pxa2xx_timer_class_init,
609feea4361SAndreas Färber };
610feea4361SAndreas Färber 
61183f7d43aSAndreas Färber static void pxa2xx_timer_register_types(void)
612797e9542SDmitry Eremin-Solenikov {
613feea4361SAndreas Färber     type_register_static(&pxa2xx_timer_type_info);
61439bffca2SAnthony Liguori     type_register_static(&pxa25x_timer_dev_info);
61539bffca2SAnthony Liguori     type_register_static(&pxa27x_timer_dev_info);
61683f7d43aSAndreas Färber }
61783f7d43aSAndreas Färber 
61883f7d43aSAndreas Färber type_init(pxa2xx_timer_register_types)
619