2 * General purpose implementation of a simple periodic countdown timer.
4 * Copyright (c) 2007 CodeSourcery.
6 * This code is licenced under the GNU LGPL.
13 int enabled
; /* 0 = disabled, 1 = periodic, 2 = oneshot. */
24 /* Use a bottom-half routine to avoid reentrancy issues. */
25 static void ptimer_trigger(ptimer_state
*s
)
28 qemu_bh_schedule(s
->bh
);
32 static void ptimer_reload(ptimer_state
*s
)
38 if (s
->delta
== 0 || s
->period
== 0) {
39 fprintf(stderr
, "Timer with period zero, disabling\n");
44 s
->last_event
= s
->next_event
;
45 s
->next_event
= s
->last_event
+ s
->delta
* s
->period
;
47 s
->next_event
+= ((int64_t)s
->period_frac
* s
->delta
) >> 32;
49 qemu_mod_timer(s
->timer
, s
->next_event
);
52 static void ptimer_tick(void *opaque
)
54 ptimer_state
*s
= (ptimer_state
*)opaque
;
57 if (s
->enabled
== 2) {
64 uint64_t ptimer_get_count(ptimer_state
*s
)
70 now
= qemu_get_clock(vm_clock
);
71 /* Figure out the current counter value. */
72 if (now
- s
->next_event
> 0
74 /* Prevent timer underflowing if it should already have
81 rem
= s
->next_event
- now
;
91 void ptimer_set_count(ptimer_state
*s
, uint64_t count
)
95 s
->next_event
= qemu_get_clock(vm_clock
);
100 void ptimer_run(ptimer_state
*s
, int oneshot
)
102 if (s
->period
== 0) {
103 fprintf(stderr
, "Timer with period zero, disabling\n");
106 s
->enabled
= oneshot
? 2 : 1;
107 s
->next_event
= qemu_get_clock(vm_clock
);
111 /* Pause a timer. Note that this may cause it to "lose" time, even if it
112 is immediately restarted. */
113 void ptimer_stop(ptimer_state
*s
)
118 s
->delta
= ptimer_get_count(s
);
119 qemu_del_timer(s
->timer
);
123 /* Set counter increment interval in nanoseconds. */
124 void ptimer_set_period(ptimer_state
*s
, int64_t period
)
129 s
->next_event
= qemu_get_clock(vm_clock
);
134 /* Set counter frequency in Hz. */
135 void ptimer_set_freq(ptimer_state
*s
, uint32_t freq
)
137 s
->period
= 1000000000ll / freq
;
138 s
->period_frac
= (1000000000ll << 32) / freq
;
140 s
->next_event
= qemu_get_clock(vm_clock
);
145 /* Set the initial countdown value. If reload is nonzero then also set
147 void ptimer_set_limit(ptimer_state
*s
, uint64_t limit
, int reload
)
152 if (s
->enabled
&& reload
) {
153 s
->next_event
= qemu_get_clock(vm_clock
);
158 void qemu_put_ptimer(QEMUFile
*f
, ptimer_state
*s
)
160 qemu_put_byte(f
, s
->enabled
);
161 qemu_put_be64s(f
, &s
->limit
);
162 qemu_put_be64s(f
, &s
->delta
);
163 qemu_put_be32s(f
, &s
->period_frac
);
164 qemu_put_be64s(f
, &s
->period
);
165 qemu_put_be64s(f
, &s
->last_event
);
166 qemu_put_be64s(f
, &s
->next_event
);
167 qemu_put_timer(f
, s
->timer
);
170 void qemu_get_ptimer(QEMUFile
*f
, ptimer_state
*s
)
172 s
->enabled
= qemu_get_byte(f
);
173 qemu_get_be64s(f
, &s
->limit
);
174 qemu_get_be64s(f
, &s
->delta
);
175 qemu_get_be32s(f
, &s
->period_frac
);
176 qemu_get_be64s(f
, &s
->period
);
177 qemu_get_be64s(f
, &s
->last_event
);
178 qemu_get_be64s(f
, &s
->next_event
);
179 qemu_get_timer(f
, s
->timer
);
182 ptimer_state
*ptimer_init(QEMUBH
*bh
)
186 s
= (ptimer_state
*)qemu_mallocz(sizeof(ptimer_state
));
188 s
->timer
= qemu_new_timer(vm_clock
, ptimer_tick
, s
);