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 "s5l8720.h"
 27 
#include "s5l8720.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 
    TFCMD = (1 << 1);   /* TF_CLR */
 36 
    TFCMD = (1 << 1);   /* TF_CLR */
39 
    TGCMD = (1 << 1);   /* TG_CLR */
 37 
    TGCMD = (1 << 1);   /* TG_CLR */
40 
    THCMD = (1 << 1);   /* TH_CLR */
 38 
    THCMD = (1 << 1);   /* TH_CLR */
- 
 
 39 
}
41 
 
 40 
 
- 
 
 41 
void timer_schedule_wakeup(uint32_t usecs)
- 
 
 42 
{
- 
 
 43 
    if (usecs > 16146247)
- 
 
 44 
    {
- 
 
 45 
        TBPRE = 511;
- 
 
 46 
        TBDATA1 = 65535;
- 
 
 47 
    }
- 
 
 48 
    else if (usecs > 31535)
- 
 
 49 
    {
- 
 
 50 
        TBPRE = 511;
42 
    /* configure timer for 10 kHz */
 51 
        TBDATA1 = (usecs * 133) >> 15;
- 
 
 52 
    }
- 
 
 53 
    else
- 
 
 54 
    {
- 
 
 55 
        TBPRE = 0;
43 
    TBPRE = 208 - 1;    /* prescaler */
 56 
        TBDATA1 = (usecs * 133) >> 6;
- 
 
 57 
    }
44 
    TBCON = (0 << 13) | /* TB_INT1_EN */
 58 
    TBCON = (1 << 13) | /* TB_INT1_EN */
45 
            (1 << 12) | /* TB_INT0_EN */
 59 
            (0 << 12) | /* TB_INT0_EN */
46 
            (0 << 11) | /* TB_START */
 60 
            (0 << 11) | /* TB_START */
47 
            (3 << 8) |  /* TB_CS = PCLK / 64 */
 61 
            (3 << 8) |  /* TB_CS = PCLK / 64 */
48 
            (0 << 4);   /* TB_MODE_SEL = interval mode */
 62 
            (2 << 4);   /* TB_MODE_SEL = one-shot mode */
49 
    TBDATA0 = cycles;   /* set interval period */
 63 
    TBCMD = (1 << 1);   /* TB_CLR */
50 
    TBCMD = (1 << 0);   /* TB_EN */
 64 
    TBCMD = (1 << 0);   /* TB_EN */
51 
}
 65 
}
52 
 
 66 
 
- 
 
 67 
void timer_kill_wakeup()
- 
 
 68 
{
- 
 
 69 
    TBCMD = (1 << 1);   /* TB_CLR */
- 
 
 70 
    TBCON = TBCON;
- 
 
 71 
}
- 
 
 72 
 
53 
void INT_TIMERB(void)
 73 
void INT_TIMERB(void)
54 
{
 74 
{
55 
    TBCON = TBCON;
 75 
    TBCON = TBCON;
56 
    scheduler_switch(NULL, NULL);
 76 
    scheduler_switch(NULL, NULL);
57 
}
 77 
}