139 lines
3.2 KiB
C
139 lines
3.2 KiB
C
#include <stdio.h>
|
|
#include <stdint.h>
|
|
#include <string.h>
|
|
#include <wchar.h>
|
|
#include "86box.h"
|
|
#include "timer.h"
|
|
|
|
|
|
#define TIMERS_MAX 64
|
|
|
|
|
|
static struct
|
|
{
|
|
int64_t present;
|
|
void (*callback)(void *priv);
|
|
void *priv;
|
|
int64_t *enable;
|
|
int64_t *count;
|
|
} timers[TIMERS_MAX];
|
|
|
|
|
|
int64_t TIMER_USEC;
|
|
int64_t timers_present = 0;
|
|
int64_t timer_one = 1;
|
|
|
|
int64_t timer_count = 0, timer_latch = 0;
|
|
int64_t timer_start = 0;
|
|
|
|
|
|
void timer_process(void)
|
|
{
|
|
int64_t c;
|
|
int64_t process = 0;
|
|
/*Get actual elapsed time*/
|
|
int64_t diff = timer_latch - timer_count;
|
|
int64_t enable[TIMERS_MAX];
|
|
|
|
timer_latch = 0;
|
|
|
|
for (c = 0; c < timers_present; c++)
|
|
{
|
|
/* This is needed to avoid timer crashes on hard reset. */
|
|
if ((timers[c].enable == NULL) || (timers[c].count == NULL))
|
|
{
|
|
continue;
|
|
}
|
|
enable[c] = *timers[c].enable;
|
|
if (*timers[c].enable)
|
|
{
|
|
*timers[c].count = *timers[c].count - diff;
|
|
if (*timers[c].count <= 0)
|
|
process = 1;
|
|
}
|
|
}
|
|
|
|
if (!process)
|
|
return;
|
|
|
|
while (1)
|
|
{
|
|
int64_t lowest = 1, lowest_c;
|
|
|
|
for (c = 0; c < timers_present; c++)
|
|
{
|
|
if (enable[c])
|
|
{
|
|
if (*timers[c].count < lowest)
|
|
{
|
|
lowest = *timers[c].count;
|
|
lowest_c = c;
|
|
}
|
|
}
|
|
}
|
|
|
|
if (lowest > 0)
|
|
break;
|
|
|
|
timers[lowest_c].callback(timers[lowest_c].priv);
|
|
enable[lowest_c] = *timers[lowest_c].enable;
|
|
}
|
|
}
|
|
|
|
|
|
void timer_update_outstanding(void)
|
|
{
|
|
int64_t c;
|
|
timer_latch = 0x7fffffffffffffff;
|
|
for (c = 0; c < timers_present; c++)
|
|
{
|
|
if (*timers[c].enable && *timers[c].count < timer_latch)
|
|
timer_latch = *timers[c].count;
|
|
}
|
|
timer_count = timer_latch = (timer_latch + ((1 << TIMER_SHIFT) - 1));
|
|
}
|
|
|
|
|
|
void timer_reset(void)
|
|
{
|
|
/* pclog("timer_reset\n"); */
|
|
timers_present = 0;
|
|
timer_latch = timer_count = 0;
|
|
}
|
|
|
|
|
|
int64_t timer_add(void (*callback)(void *priv), int64_t *count, int64_t *enable, void *priv)
|
|
{
|
|
int64_t i = 0;
|
|
|
|
if (timers_present < TIMERS_MAX)
|
|
{
|
|
if (timers_present != 0)
|
|
{
|
|
/* This is the sanity check - it goes through all present timers and makes sure we're not adding a timer that already exists. */
|
|
for (i = 0; i < timers_present; i++)
|
|
{
|
|
if (timers[i].present && (timers[i].callback == callback) && (timers[i].priv == priv) && (timers[i].count == count) && (timers[i].enable == enable))
|
|
{
|
|
return 0;
|
|
}
|
|
}
|
|
}
|
|
|
|
timers[timers_present].present = 1;
|
|
timers[timers_present].callback = callback;
|
|
timers[timers_present].priv = priv;
|
|
timers[timers_present].count = count;
|
|
timers[timers_present].enable = enable;
|
|
timers_present++;
|
|
return timers_present - 1;
|
|
}
|
|
return -1;
|
|
}
|
|
|
|
|
|
void timer_set_callback(int64_t timer, void (*callback)(void *priv))
|
|
{
|
|
timers[timer].callback = callback;
|
|
}
|