Subversion Repositories freemyipod

Rev

Rev 597 | Details | Compare with Previous | Last modification | View Log | RSS feed

Rev Author Line No. Line
85 theseven 1
//
2
//
3
//    Copyright 2010 TheSeven
4
//
5
//
427 farthen 6
//    This file is part of emCORE.
85 theseven 7
//
427 farthen 8
//    emCORE is free software: you can redistribute it and/or
85 theseven 9
//    modify it under the terms of the GNU General Public License as
10
//    published by the Free Software Foundation, either version 2 of the
11
//    License, or (at your option) any later version.
12
//
427 farthen 13
//    emCORE is distributed in the hope that it will be useful,
85 theseven 14
//    but WITHOUT ANY WARRANTY; without even the implied warranty of
15
//    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.
16
//    See the GNU General Public License for more details.
17
//
18
//    You should have received a copy of the GNU General Public License along
427 farthen 19
//    with emCORE.  If not, see <http://www.gnu.org/licenses/>.
85 theseven 20
//
21
//
22
 
23
 
24
#include "global.h"
25
#include "timer.h"
26
#include "thread.h"
27
#include "s5l8720.h"
28
 
29
 
597 theseven 30
void timer_init()
85 theseven 31
{
32
    TACMD = (1 << 1);   /* TA_CLR */
33
    TBCMD = (1 << 1);   /* TB_CLR */
34
    TCCMD = (1 << 1);   /* TC_CLR */
35
    TDCMD = (1 << 1);   /* TD_CLR */
36
    TFCMD = (1 << 1);   /* TF_CLR */
37
    TGCMD = (1 << 1);   /* TG_CLR */
38
    THCMD = (1 << 1);   /* TH_CLR */
597 theseven 39
}
85 theseven 40
 
597 theseven 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;
51
        TBDATA1 = (usecs * 133) >> 15;
52
    }
53
    else
54
    {
55
        TBPRE = 0;
56
        TBDATA1 = (usecs * 133) >> 6;
57
    }
58
    TBCON = (1 << 13) | /* TB_INT1_EN */
59
            (0 << 12) | /* TB_INT0_EN */
85 theseven 60
            (0 << 11) | /* TB_START */
61
            (3 << 8) |  /* TB_CS = PCLK / 64 */
597 theseven 62
            (2 << 4);   /* TB_MODE_SEL = one-shot mode */
63
    TBCMD = (1 << 1);   /* TB_CLR */
85 theseven 64
    TBCMD = (1 << 0);   /* TB_EN */
65
}
66
 
597 theseven 67
void timer_kill_wakeup()
68
{
69
    TBCMD = (1 << 1);   /* TB_CLR */
70
    TBCON = TBCON;
71
}
72
 
85 theseven 73
void INT_TIMERB(void)
74
{
75
    TBCON = TBCON;
595 theseven 76
    scheduler_switch(NULL, NULL);
85 theseven 77
}