arm9/src/timer3.c


1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66

#include "timer3.h"

struct Timer3Data timer3_data;


THUMB_FUNC void Init_Timer3()
{
    timer3_data.Timer3Counter = 0;
    timer3_data.NeedReset = FALSE;

    reg_OS_TM3CNT_H = 0;
    reg_OS_TM3CNT_L = 0;
    reg_OS_TM3CNT_H = 0xc1; // start timer3 with f/64 and irq enable

    OS_SetIrqFunction(0x40, &CountUpTimer3);
    OS_EnableIrqMask(0x40); // irq on timer3 overflow
}


THUMB_FUNC void CountUpTimer3()
{
    timer3_data.Timer3Counter++;

    if (timer3_data.NeedReset)
    {
        reg_OS_TM3CNT_H = 0;
        reg_OS_TM3CNT_L = 0;
        reg_OS_TM3CNT_H = 0xc1;
        timer3_data.NeedReset = FALSE;
    }

    *(vu32 *)HW_INTR_CHECK_BUF |= 0x40;

    OS_SetIrqFunction(0x40, &CountUpTimer3);
}

THUMB_FUNC u64 internal_GetTimer3Count()
{
    OSIntrMode intr_mode = OS_DisableInterrupts();

    vu16 timer3 = reg_OS_TM3CNT_L;
    vu64 timer3_counter = timer3_data.Timer3Counter & 0x0000ffffffffffff;

    if (reg_OS_IF & 0x40 && !(timer3 & 0x8000))
    {
        timer3_counter++;
    }

    OS_RestoreInterrupts(intr_mode);
    return (timer3_counter << 16) | timer3;
}

THUMB_FUNC u64 GetTimer3Count()
{
    return internal_GetTimer3Count();
}

THUMB_FUNC u64 Timer3CountToMilliSeconds(u64 count)
{
    return (count *64) / 33514;
}

THUMB_FUNC u64 Timer3CountToSeconds(u64 count)
{
    return (count *64) / HW_SYSTEM_CLOCK;
}