Subversion Repositories freemyipod

Rev

Go to most recent revision | Details | Last modification | View Log | RSS feed

Rev Author Line No. Line
14 theseven 1
//
2
//
3
//    Copyright 2010 TheSeven
4
//
5
//
427 farthen 6
//    This file is part of emCORE.
14 theseven 7
//
427 farthen 8
//    emCORE is free software: you can redistribute it and/or
14 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,
14 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/>.
14 theseven 20
//
21
//
22
 
23
 
24
#include "global.h"
25
#include "timer.h"
26
#include "thread.h"
27
#include "s5l8701.h"
28
 
29
 
597 theseven 30
void timer_init()
14 theseven 31
{
597 theseven 32
}
33
 
34
void timer_schedule_wakeup(uint32_t usecs)
35
{
36
    if (usecs > 11184640)
37
    {
38
        TBPRE = 511;
39
        TBDATA1 = 65535;
40
    }
41
    else if (usecs > 21845)
42
    {
43
        TBPRE = 511;
44
        TBDATA1 = (usecs * 192) >> 15;
45
    }
46
    else
47
    {
48
        TBPRE = 0;
49
        TBDATA1 = (usecs * 192) >> 6;
50
    }
51
    TBCON = (1 << 13) | /* TB_INT1_EN */
52
            (0 << 12) | /* TB_INT0_EN */
14 theseven 53
            (0 << 11) | /* TB_START */
54
            (2 << 8) |  /* TB_CS = PCLK / 16 */
597 theseven 55
            (2 << 4);   /* TB_MODE_SEL = one-shot mode */
56
    TBCMD = (1 << 1);   /* TB_CLR */
14 theseven 57
    TBCMD = (1 << 0);   /* TB_EN */
58
}
59
 
597 theseven 60
void timer_kill_wakeup()
61
{
62
    TBCMD = (1 << 1);   /* TB_CLR */
63
    TBCON = TBCON;
64
}
65
 
14 theseven 66
void INT_TIMERB(void)
67
{
68
    TBCON = TBCON;
595 theseven 69
    scheduler_switch(NULL, NULL);
14 theseven 70
}