More timer fixes, fixes Trantor T128b.
This commit is contained in:
69
src/timer.c
69
src/timer.c
@@ -15,7 +15,9 @@ pc_timer_t *timer_head = NULL;
|
||||
/* Are we initialized? */
|
||||
int timer_inited = 0;
|
||||
|
||||
static void timer_advance_ex(pc_timer_t *timer);
|
||||
static int timer_in_process = 0;
|
||||
|
||||
static void timer_advance_ex(pc_timer_t *timer, int start);
|
||||
|
||||
void
|
||||
timer_enable(pc_timer_t *timer)
|
||||
@@ -114,6 +116,8 @@ timer_process(void)
|
||||
if (!timer_head)
|
||||
return;
|
||||
|
||||
timer_in_process = 0;
|
||||
|
||||
while (1) {
|
||||
timer = timer_head;
|
||||
|
||||
@@ -127,18 +131,18 @@ timer_process(void)
|
||||
timer->next = timer->prev = NULL;
|
||||
timer->flags &= ~TIMER_ENABLED;
|
||||
|
||||
timer->flags |= TIMER_PROCESS;
|
||||
if (timer->flags & TIMER_SPLIT)
|
||||
timer_advance_ex(timer); /* We're splitting a > 1 s period into
|
||||
timer_advance_ex(timer, 0); /* We're splitting a > 1 s period into
|
||||
multiple <= 1 s periods. */
|
||||
else if (timer->callback != NULL) /* Make sure it's not NULL, so that we can
|
||||
have a NULL callback when no operation
|
||||
is needed. */
|
||||
timer->callback(timer->priv);
|
||||
timer->flags &= ~TIMER_PROCESS;
|
||||
}
|
||||
|
||||
timer_target = timer_head->ts.ts32.integer;
|
||||
|
||||
timer_in_process = 1;
|
||||
}
|
||||
|
||||
void
|
||||
@@ -191,47 +195,62 @@ timer_stop(pc_timer_t *timer)
|
||||
return;
|
||||
|
||||
timer->period = 0.0;
|
||||
if (timer_is_enabled(timer))
|
||||
timer_disable(timer);
|
||||
timer_disable(timer);
|
||||
timer->flags &= ~TIMER_SPLIT;
|
||||
}
|
||||
|
||||
static void
|
||||
timer_do_period(pc_timer_t *timer, uint64_t period)
|
||||
timer_do_period(pc_timer_t *timer, uint64_t period, int start)
|
||||
{
|
||||
if (timer->flags & TIMER_PROCESS)
|
||||
timer_advance_u64(timer, period);
|
||||
else
|
||||
if (!timer_inited || (timer == NULL))
|
||||
return;
|
||||
|
||||
if (start)
|
||||
timer_set_delay_u64(timer, period);
|
||||
else
|
||||
timer_advance_u64(timer, period);
|
||||
}
|
||||
|
||||
static void
|
||||
timer_advance_ex(pc_timer_t *timer)
|
||||
timer_advance_ex(pc_timer_t *timer, int start)
|
||||
{
|
||||
double dusec = ((double) TIMER_USEC);
|
||||
double period;
|
||||
if (!timer_inited || (timer == NULL))
|
||||
return;
|
||||
|
||||
period = (timer->period > MAX_USEC) ? MAX_USEC64 : timer->period;
|
||||
|
||||
if (timer->period > 0.0) {
|
||||
timer_do_period(timer, (uint64_t) (period * dusec));
|
||||
timer->period -= period;
|
||||
timer->flags = (timer->flags & ~TIMER_SPLIT) | ((timer->period > MAX_USEC) ? TIMER_SPLIT : 0);
|
||||
} else if (timer_is_enabled(timer)) {
|
||||
timer_disable(timer);
|
||||
if (timer->period > MAX_USEC) {
|
||||
timer_do_period(timer, MAX_USEC64 * TIMER_USEC, start);
|
||||
timer->period -= MAX_USEC;
|
||||
timer->flags |= TIMER_SPLIT;
|
||||
} else {
|
||||
if (timer->period > 0.0)
|
||||
timer_do_period(timer, (uint64_t) (timer->period * ((double) TIMER_USEC)), start);
|
||||
else
|
||||
timer_disable(timer);
|
||||
timer->period = 0.0;
|
||||
timer->flags &= ~TIMER_SPLIT;
|
||||
}
|
||||
}
|
||||
|
||||
static void
|
||||
timer_on(pc_timer_t *timer, double period, int start)
|
||||
{
|
||||
if (!timer_inited || (timer == NULL))
|
||||
return;
|
||||
|
||||
timer->period = period;
|
||||
timer_advance_ex(timer, start);
|
||||
}
|
||||
|
||||
void
|
||||
timer_on_auto(pc_timer_t *timer, double period)
|
||||
{
|
||||
uint32_t *p = NULL;
|
||||
|
||||
if (!timer_inited || (timer == NULL))
|
||||
return;
|
||||
|
||||
if (period > 0.0) {
|
||||
timer->period = period;
|
||||
timer_advance_ex(timer);
|
||||
} else if (timer_is_on(timer))
|
||||
if (period > 0.0)
|
||||
timer_on(timer, period, !timer_in_process && (timer->period <= 0.0));
|
||||
else
|
||||
timer_stop(timer);
|
||||
}
|
||||
|
||||
Reference in New Issue
Block a user