diff options
Diffstat (limited to 'firmware/target/sh')
-rw-r--r-- | firmware/target/sh/archos/timer-archos.c | 85 | ||||
-rw-r--r-- | firmware/target/sh/archos/timer-target.h | 41 |
2 files changed, 126 insertions, 0 deletions
diff --git a/firmware/target/sh/archos/timer-archos.c b/firmware/target/sh/archos/timer-archos.c new file mode 100644 index 0000000000..e7526a8409 --- /dev/null +++ b/firmware/target/sh/archos/timer-archos.c | |||
@@ -0,0 +1,85 @@ | |||
1 | /*************************************************************************** | ||
2 | * __________ __ ___. | ||
3 | * Open \______ \ ____ ____ | | _\_ |__ _______ ___ | ||
4 | * Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ / | ||
5 | * Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < < | ||
6 | * Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \ | ||
7 | * \/ \/ \/ \/ \/ | ||
8 | * $Id$ | ||
9 | * | ||
10 | * Copyright (C) 2005 Jens Arnold | ||
11 | * | ||
12 | * This program is free software; you can redistribute it and/or | ||
13 | * modify it under the terms of the GNU General Public License | ||
14 | * as published by the Free Software Foundation; either version 2 | ||
15 | * of the License, or (at your option) any later version. | ||
16 | * | ||
17 | * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY | ||
18 | * KIND, either express or implied. | ||
19 | * | ||
20 | ****************************************************************************/ | ||
21 | |||
22 | #include "cpu.h" | ||
23 | #include "system.h" | ||
24 | #include "timer.h" | ||
25 | #include "timer-target.h" | ||
26 | |||
27 | void IMIA4(void) __attribute__((interrupt_handler)); | ||
28 | void IMIA4(void) | ||
29 | { | ||
30 | if (pfn_timer != NULL) | ||
31 | pfn_timer(); | ||
32 | and_b(~0x01, &TSR4); /* clear the interrupt */ | ||
33 | } | ||
34 | |||
35 | bool __timer_set(long cycles, bool start) | ||
36 | { | ||
37 | int phi = 0; /* bits for the prescaler */ | ||
38 | int prescale = 1; | ||
39 | |||
40 | while (cycles > 0x10000) | ||
41 | { /* work out the smallest prescaler that makes it fit */ | ||
42 | phi++; | ||
43 | prescale <<= 1; | ||
44 | cycles >>= 1; | ||
45 | } | ||
46 | |||
47 | if (prescale > 8) | ||
48 | return false; | ||
49 | |||
50 | if (start) | ||
51 | { | ||
52 | if (pfn_unregister != NULL) | ||
53 | { | ||
54 | pfn_unregister(); | ||
55 | pfn_unregister = NULL; | ||
56 | } | ||
57 | |||
58 | and_b(~0x10, &TSTR); /* Stop the timer 4 */ | ||
59 | and_b(~0x10, &TSNC); /* No synchronization */ | ||
60 | and_b(~0x10, &TMDR); /* Operate normally */ | ||
61 | |||
62 | TIER4 = 0xF9; /* Enable GRA match interrupt */ | ||
63 | } | ||
64 | |||
65 | TCR4 = 0x20 | phi; /* clear at GRA match, set prescaler */ | ||
66 | GRA4 = (unsigned short)(cycles - 1); | ||
67 | if (start || (TCNT4 >= GRA4)) | ||
68 | TCNT4 = 0; | ||
69 | and_b(~0x01, &TSR4); /* clear an eventual interrupt */ | ||
70 | |||
71 | return true; | ||
72 | } | ||
73 | |||
74 | bool __timer_start(int int_prio) | ||
75 | { | ||
76 | IPRD = (IPRD & 0xFF0F) | int_prio << 4; /* interrupt priority */ | ||
77 | or_b(0x10, &TSTR); /* start timer 4 */ | ||
78 | return true; | ||
79 | } | ||
80 | |||
81 | void __timer_stop(void) | ||
82 | { | ||
83 | and_b(~0x10, &TSTR); /* stop the timer 4 */ | ||
84 | IPRD = (IPRD & 0xFF0F); /* disable interrupt */ | ||
85 | } | ||
diff --git a/firmware/target/sh/archos/timer-target.h b/firmware/target/sh/archos/timer-target.h new file mode 100644 index 0000000000..08fcae1156 --- /dev/null +++ b/firmware/target/sh/archos/timer-target.h | |||
@@ -0,0 +1,41 @@ | |||
1 | /*************************************************************************** | ||
2 | * __________ __ ___. | ||
3 | * Open \______ \ ____ ____ | | _\_ |__ _______ ___ | ||
4 | * Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ / | ||
5 | * Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < < | ||
6 | * Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \ | ||
7 | * \/ \/ \/ \/ \/ | ||
8 | * $Id$ | ||
9 | * | ||
10 | * Copyright (C) 2005 Jens Arnold | ||
11 | * | ||
12 | * This program is free software; you can redistribute it and/or | ||
13 | * modify it under the terms of the GNU General Public License | ||
14 | * as published by the Free Software Foundation; either version 2 | ||
15 | * of the License, or (at your option) any later version. | ||
16 | * | ||
17 | * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY | ||
18 | * KIND, either express or implied. | ||
19 | * | ||
20 | ****************************************************************************/ | ||
21 | #ifndef TIMER_TARGET_H | ||
22 | #define TIMER_TARGET_H | ||
23 | |||
24 | #include "config.h" | ||
25 | |||
26 | bool __timer_set(long cycles, bool start); | ||
27 | bool __timer_start(int int_prio); | ||
28 | void __timer_stop(void); | ||
29 | |||
30 | #define TIMER_FREQ CPU_FREQ | ||
31 | |||
32 | #define __TIMER_SET(cycles, set) \ | ||
33 | __timer_set(cycles, set) | ||
34 | |||
35 | #define __TIMER_START(int_prio) \ | ||
36 | __timer_start(int_prio) | ||
37 | |||
38 | #define __TIMER_STOP(...) \ | ||
39 | __timer_stop() | ||
40 | |||
41 | #endif /* TIMER_TARGET_H */ | ||