51 lines
1.1 KiB
C
51 lines
1.1 KiB
C
#include <signal.h>
|
|
#include <stdlib.h>
|
|
#include <sys/time.h>
|
|
|
|
#include "dda_queue.h"
|
|
#include "timer.h"
|
|
#include "simulation.h"
|
|
|
|
static bool timer_initialised = false;
|
|
|
|
void setupTimerInterrupt(void)
|
|
{
|
|
disableTimerInterrupt();
|
|
sim_info("setupTimerInterrupt");
|
|
timer_initialised = true;
|
|
}
|
|
|
|
static void timer1_isr(int cause, siginfo_t *HowCome, void *ucontext)
|
|
{
|
|
if (!sim_interrupts || !timerInterruptIsEnabled()) return;
|
|
|
|
sim_interrupts = false;
|
|
|
|
WRITE(SCK, 1);
|
|
queue_step();
|
|
WRITE(SCK, 0);
|
|
|
|
sim_interrupts = true;
|
|
}
|
|
|
|
void setTimer(uint32_t delay)
|
|
{
|
|
struct itimerval itimer;
|
|
struct sigaction sa;
|
|
|
|
sim_assert(timer_initialised, "timer not initialised");
|
|
|
|
sa.sa_sigaction = timer1_isr;
|
|
sigemptyset(&sa.sa_mask);
|
|
sa.sa_flags = SA_SIGINFO;
|
|
if (sigaction(SIGPROF, &sa, 0)) {
|
|
sim_error("sigaction");
|
|
}
|
|
itimer.it_interval.tv_sec = 0;
|
|
itimer.it_interval.tv_usec = (long)delay * 8000000 / F_CPU;
|
|
itimer.it_value.tv_sec = 0;
|
|
itimer.it_value.tv_usec = itimer.it_interval.tv_usec;
|
|
setitimer(ITIMER_PROF, &itimer, NULL);
|
|
}
|
|
|