73de812cb6
git-svn-id: svn://svn.rockbox.org/rockbox/trunk@16226 a1c6a512-1295-4272-9138-f99709370657
55 lines
1.5 KiB
C
55 lines
1.5 KiB
C
#include "config.h"
|
|
#include "system.h"
|
|
#include "avic-imx31.h"
|
|
#include "kernel.h"
|
|
#include "thread.h"
|
|
#include <stdio.h>
|
|
|
|
extern void (*tick_funcs[MAX_NUM_TICK_TASKS])(void);
|
|
|
|
#ifndef BOOTLOADER
|
|
static __attribute__((interrupt("IRQ"))) void EPIT1_HANDLER(void)
|
|
{
|
|
int i;
|
|
|
|
EPITSR1 = 1; /* Clear the pending status */
|
|
|
|
/* Run through the list of tick tasks */
|
|
for(i = 0;i < MAX_NUM_TICK_TASKS;i++)
|
|
{
|
|
if(tick_funcs[i])
|
|
tick_funcs[i]();
|
|
}
|
|
|
|
current_tick++;
|
|
}
|
|
#endif
|
|
|
|
void tick_start(unsigned int interval_in_ms)
|
|
{
|
|
EPITCR1 &= ~(1 << 0); /* Disable the counter */
|
|
EPITCR1 |= (1 << 16); /* Reset */
|
|
|
|
CLKCTL_CGR0 |= (0x3 << 6); /* Clock ON */
|
|
CLKCTL_WIMR0 &= ~(1 << 23); /* Clear wakeup mask */
|
|
|
|
/* NOTE: This isn't really accurate yet but it's close enough to work
|
|
* with for the moment */
|
|
|
|
/* CLKSRC=32KHz, EPIT Output Disconnected, Enabled
|
|
* prescale 1/32, Reload from modulus register, Compare interrupt enabled,
|
|
* Count from load value */
|
|
EPITCR1 = (0x3 << 24) | (1 << 19) | (32 << 4) |
|
|
(1 << 3) | (1 << 2) | (1 << 1);
|
|
#ifndef BOOTLOADER
|
|
EPITLR1 = interval_in_ms;
|
|
EPITCMPR1 = 0; /* Event when counter reaches 0 */
|
|
avic_enable_int(EPIT1, IRQ, EPIT1_HANDLER);
|
|
#else
|
|
(void)interval_in_ms;
|
|
#endif
|
|
EPITSR1 = 1; /* Clear any pending interrupt after
|
|
enabling the vector */
|
|
|
|
EPITCR1 |= (1 << 0); /* Enable the counter */
|
|
}
|