diff options
Diffstat (limited to 'firmware/target/arm/tms320dm320/system-mr500.c')
-rw-r--r-- | firmware/target/arm/tms320dm320/system-mr500.c | 210 |
1 files changed, 210 insertions, 0 deletions
diff --git a/firmware/target/arm/tms320dm320/system-mr500.c b/firmware/target/arm/tms320dm320/system-mr500.c new file mode 100644 index 0000000000..fad2d4331e --- /dev/null +++ b/firmware/target/arm/tms320dm320/system-mr500.c | |||
@@ -0,0 +1,210 @@ | |||
1 | /*************************************************************************** | ||
2 | * __________ __ ___. | ||
3 | * Open \______ \ ____ ____ | | _\_ |__ _______ ___ | ||
4 | * Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ / | ||
5 | * Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < < | ||
6 | * Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \ | ||
7 | * \/ \/ \/ \/ \/ | ||
8 | * $Id$ | ||
9 | * | ||
10 | * Copyright (C) 2007 by Karl Kurbjun | ||
11 | * | ||
12 | * All files in this archive are subject to the GNU General Public License. | ||
13 | * See the file COPYING in the source tree root for full license agreement. | ||
14 | * | ||
15 | * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY | ||
16 | * KIND, either express or implied. | ||
17 | * | ||
18 | ****************************************************************************/ | ||
19 | |||
20 | #include "kernel.h" | ||
21 | #include "system.h" | ||
22 | #include "panic.h" | ||
23 | |||
24 | #define default_interrupt(name) \ | ||
25 | extern __attribute__((weak,alias("UIRQ"))) void name (void) | ||
26 | |||
27 | default_interrupt(TIMER0); | ||
28 | default_interrupt(TIMER1); | ||
29 | default_interrupt(TIMER2); | ||
30 | default_interrupt(TIMER3); | ||
31 | default_interrupt(CCD_VD0); | ||
32 | default_interrupt(CCD_VD1); | ||
33 | default_interrupt(CCD_WEN); | ||
34 | default_interrupt(VENC); | ||
35 | default_interrupt(SERIAL0); | ||
36 | default_interrupt(SERIAL1); | ||
37 | default_interrupt(EXT_HOST); | ||
38 | default_interrupt(DSPHINT); | ||
39 | default_interrupt(UART0); | ||
40 | default_interrupt(UART1); | ||
41 | default_interrupt(USB_DMA); | ||
42 | default_interrupt(USB_CORE); | ||
43 | default_interrupt(VLYNQ); | ||
44 | default_interrupt(MTC0); | ||
45 | default_interrupt(MTC1); | ||
46 | default_interrupt(SD_MMC); | ||
47 | default_interrupt(SDIO_MS); | ||
48 | default_interrupt(GIO0); | ||
49 | default_interrupt(GIO1); | ||
50 | default_interrupt(GIO2); | ||
51 | default_interrupt(GIO3); | ||
52 | default_interrupt(GIO4); | ||
53 | default_interrupt(GIO5); | ||
54 | default_interrupt(GIO6); | ||
55 | default_interrupt(GIO7); | ||
56 | default_interrupt(GIO8); | ||
57 | default_interrupt(GIO9); | ||
58 | default_interrupt(GIO10); | ||
59 | default_interrupt(GIO11); | ||
60 | default_interrupt(GIO12); | ||
61 | default_interrupt(GIO13); | ||
62 | default_interrupt(GIO14); | ||
63 | default_interrupt(GIO15); | ||
64 | default_interrupt(PREVIEW0); | ||
65 | default_interrupt(PREVIEW1); | ||
66 | default_interrupt(WATCHDOG); | ||
67 | default_interrupt(I2C); | ||
68 | default_interrupt(CLKC); | ||
69 | default_interrupt(ICE); | ||
70 | default_interrupt(ARMCOM_RX); | ||
71 | default_interrupt(ARMCOM_TX); | ||
72 | default_interrupt(RESERVED); | ||
73 | |||
74 | static void (* const irqvector[])(void) = | ||
75 | { | ||
76 | TIMER0,TIMER1,TIMER2,TIMER3,CCD_VD0,CCD_VD1, | ||
77 | CCD_WEN,VENC,SERIAL0,SERIAL1,EXT_HOST,DSPHINT, | ||
78 | UART0,UART1,USB_DMA,USB_CORE,VLYNQ,MTC0,MTC1, | ||
79 | SD_MMC,SDIO_MS,GIO0,GIO1,GIO2,GIO3,GIO4,GIO5, | ||
80 | GIO6,GIO7,GIO8,GIO9,GIO10,GIO11,GIO12,GIO13, | ||
81 | GIO14,GIO15,PREVIEW0,PREVIEW1,WATCHDOG,I2C,CLKC, | ||
82 | ICE,ARMCOM_RX,ARMCOM_TX,RESERVED | ||
83 | }; | ||
84 | |||
85 | static const char * const irqname[] = | ||
86 | { | ||
87 | "TIMER0","TIMER1","TIMER2","TIMER3","CCD_VD0","CCD_VD1", | ||
88 | "CCD_WEN","VENC","SERIAL0","SERIAL1","EXT_HOST","DSPHINT", | ||
89 | "UART0","UART1","USB_DMA","USB_CORE","VLYNQ","MTC0","MTC1", | ||
90 | "SD_MMC","SDIO_MS","GIO0","GIO1","GIO2","GIO3","GIO4","GIO5", | ||
91 | "GIO6","GIO7","GIO8","GIO9","GIO10","GIO11","GIO12","GIO13", | ||
92 | "GIO14","GIO15","PREVIEW0","PREVIEW1","WATCHDOG","I2C","CLKC", | ||
93 | "ICE","ARMCOM_RX","ARMCOM_TX","RESERVED" | ||
94 | }; | ||
95 | |||
96 | static void UIRQ(void) | ||
97 | { | ||
98 | unsigned int offset = (IO_INTC_IRQENTRY0>>2)-1; | ||
99 | panicf("Unhandled IRQ %02X: %s", offset, irqname[offset]); | ||
100 | } | ||
101 | |||
102 | void irq_handler(void) __attribute__((interrupt ("IRQ"), naked)); | ||
103 | void irq_handler(void) | ||
104 | { | ||
105 | /* | ||
106 | * Based on: linux/arch/arm/kernel/entry-armv.S and system-meg-fx.c | ||
107 | */ | ||
108 | |||
109 | asm volatile( "stmfd sp!, {r0-r7, ip, lr} \n" /* Store context */ | ||
110 | "sub sp, sp, #8 \n"); /* Reserve stack */ | ||
111 | irqvector[(IO_INTC_IRQENTRY0>>2)-1](); | ||
112 | asm volatile( "add sp, sp, #8 \n" /* Cleanup stack */ | ||
113 | "ldmfd sp!, {r0-r7, ip, lr} \n" /* Restore context */ | ||
114 | "subs pc, lr, #4 \n"); /* Return from FIQ */ | ||
115 | } | ||
116 | |||
117 | void fiq_handler(void) __attribute__((interrupt ("FIQ"), naked)); | ||
118 | void fiq_handler(void) | ||
119 | { | ||
120 | /* | ||
121 | * Based on: linux/arch/arm/kernel/entry-armv.S and system-meg-fx.c | ||
122 | */ | ||
123 | |||
124 | asm volatile ( | ||
125 | "sub lr, lr, #4 \r\n" | ||
126 | "stmfd sp!, {r0-r3, ip, lr} \r\n" | ||
127 | "mov r0, #0x00030000 \r\n" | ||
128 | "ldr r0, [r0, #0x518] \r\n" | ||
129 | "ldr r1, =irqvector \r\n" | ||
130 | "ldr r1, [r1, r0, lsl #2] \r\n" | ||
131 | "mov lr, pc \r\n" | ||
132 | "bx r1 \r\n" | ||
133 | "ldmfd sp!, {r0-r3, ip, pc}^ \r\n" | ||
134 | ); | ||
135 | } | ||
136 | |||
137 | void system_reboot(void) | ||
138 | { | ||
139 | |||
140 | } | ||
141 | |||
142 | void enable_interrupts (void) | ||
143 | { | ||
144 | asm volatile ("msr cpsr_c, #0x13" ); | ||
145 | } | ||
146 | |||
147 | void system_init(void) | ||
148 | { | ||
149 | /* taken from linux/arch/arm/mach-itdm320-20/irq.c */ | ||
150 | |||
151 | /* Clearing all FIQs and IRQs. */ | ||
152 | IO_INTC_IRQ0 = 0xFFFF; | ||
153 | IO_INTC_IRQ1 = 0xFFFF; | ||
154 | IO_INTC_IRQ2 = 0xFFFF; | ||
155 | |||
156 | IO_INTC_FIQ0 = 0xFFFF; | ||
157 | IO_INTC_FIQ1 = 0xFFFF; | ||
158 | IO_INTC_FIQ2 = 0xFFFF; | ||
159 | |||
160 | /* Masking all Interrupts. */ | ||
161 | IO_INTC_EINT0 = 0; | ||
162 | IO_INTC_EINT1 = 0; | ||
163 | IO_INTC_EINT2 = 0; | ||
164 | |||
165 | /* Setting INTC to all IRQs. */ | ||
166 | IO_INTC_FISEL0 = 0; | ||
167 | IO_INTC_FISEL1 = 0; | ||
168 | IO_INTC_FISEL2 = 0; | ||
169 | |||
170 | IO_INTC_ENTRY_TBA0 = | ||
171 | IO_INTC_ENTRY_TBA1 = 0; | ||
172 | |||
173 | /* set GIO26 (reset pin) to output and low */ | ||
174 | IO_GIO_BITCLR1=(1<<10); | ||
175 | IO_GIO_DIR1&=~(1<<10); | ||
176 | |||
177 | enable_interrupts(); | ||
178 | } | ||
179 | |||
180 | int system_memory_guard(int newmode) | ||
181 | { | ||
182 | (void)newmode; | ||
183 | return 0; | ||
184 | } | ||
185 | |||
186 | #ifdef HAVE_ADJUSTABLE_CPU_FREQ | ||
187 | |||
188 | void set_cpu_frequency(long frequency) | ||
189 | { | ||
190 | if (frequency == CPUFREQ_MAX) | ||
191 | { | ||
192 | asm volatile("mov r0, #0\n" | ||
193 | "mrc p15, 0, r0, c1, c0, 0\n" | ||
194 | "orr r0, r0, #3<<30\n" /* set to Asynchronous mode*/ | ||
195 | "mcr p15, 0, r0, c1, c0, 0" : : : "r0"); | ||
196 | |||
197 | FREQ = CPUFREQ_MAX; | ||
198 | } | ||
199 | else | ||
200 | { | ||
201 | asm volatile("mov r0, #0\n" | ||
202 | "mrc p15, 0, r0, c1, c0, 0\n" | ||
203 | "bic r0, r0, #3<<30\n" /* set to FastBus mode*/ | ||
204 | "mcr p15, 0, r0, c1, c0, 0" : : : "r0"); | ||
205 | |||
206 | FREQ = CPUFREQ_NORMAL; | ||
207 | } | ||
208 | } | ||
209 | |||
210 | #endif | ||