Subversion Repositories freemyipod

Rev

Rev 595 | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed

Rev 595 Rev 597
Line 25... Line 25...
25 
#include "timer.h"
 25 
#include "timer.h"
26 
#include "thread.h"
 26 
#include "thread.h"
27 
#include "s5l8702.h"
 27 
#include "s5l8702.h"
28 
 
 28 
 
29 
 
 29 
 
30 
void setup_tick()
 30 
void timer_init()
31 
{
 31 
{
32 
    int cycles = SYSTEM_TICK / 100;
 - 
 
33
- 
 
34 
    TACMD = (1 << 1);   /* TA_CLR */
 32 
    TACMD = (1 << 1);   /* TA_CLR */
35 
    TBCMD = (1 << 1);   /* TB_CLR */
 33 
    TBCMD = (1 << 1);   /* TB_CLR */
36 
    TCCMD = (1 << 1);   /* TC_CLR */
 34 
    TCCMD = (1 << 1);   /* TC_CLR */
37 
    TDCMD = (1 << 1);   /* TD_CLR */
 35 
    TDCMD = (1 << 1);   /* TD_CLR */
38 
    TGCMD = (1 << 1);   /* TG_CLR */
 36 
    TGCMD = (1 << 1);   /* TG_CLR */
39 
    THCMD = (1 << 1);   /* TH_CLR */
 37 
    THCMD = (1 << 1);   /* TH_CLR */
- 
 
 38 
}
40 
 
 39 
 
- 
 
 40 
void timer_schedule_wakeup(uint32_t usecs)
- 
 
 41 
{
- 
 
 42 
    if (usecs > 9942053)
- 
 
 43 
    {
- 
 
 44 
        TBPRE = 511;
- 
 
 45 
        TBDATA1 = 65535;
- 
 
 46 
    }
- 
 
 47 
    else if (usecs > 19417)
- 
 
 48 
    {
- 
 
 49 
        TBPRE = 511;
41 
    /* configure timer for 10 kHz */
 50 
        TBDATA1 = (usecs * 216) >> 15;
- 
 
 51 
    }
- 
 
 52 
    else
- 
 
 53 
    {
- 
 
 54 
        TBPRE = 0;
42 
    TBPRE = 337 - 1;    /* prescaler */
 55 
        TBDATA1 = (usecs * 216) >> 6;
- 
 
 56 
    }
43 
    TBCON = (0 << 13) | /* TB_INT1_EN */
 57 
    TBCON = (1 << 13) | /* TB_INT1_EN */
44 
            (1 << 12) | /* TB_INT0_EN */
 58 
            (0 << 12) | /* TB_INT0_EN */
45 
            (0 << 11) | /* TB_START */
 59 
            (0 << 11) | /* TB_START */
46 
            (3 << 8) |  /* TB_CS = PCLK / 64 */
 60 
            (3 << 8) |  /* TB_CS = PCLK / 64 */
47 
            (0 << 4);   /* TB_MODE_SEL = interval mode */
 61 
            (2 << 4);   /* TB_MODE_SEL = one-shot mode */
48 
    TBDATA0 = cycles;   /* set interval period */
 62 
    TBCMD = (1 << 1);   /* TB_CLR */
49 
    TBCMD = (1 << 0);   /* TB_EN */
 63 
    TBCMD = (1 << 0);   /* TB_EN */
50 
}
 64 
}
51 
 
 65 
 
- 
 
 66 
void timer_kill_wakeup()
- 
 
 67 
{
- 
 
 68 
    TBCMD = (1 << 1);   /* TB_CLR */
- 
 
 69 
    TBCON = TBCON;
- 
 
 70 
}
- 
 
 71 
 
52 
void INT_TIMERB(void)
 72 
void INT_TIMERB(void)
53 
{
 73 
{
54 
    TBCON = TBCON;
 74 
    TBCON = TBCON;
55 
    scheduler_switch(NULL, NULL);
 75 
    scheduler_switch(NULL, NULL);
56 
}
 76 
}