diff options
author | Mikael Starvik <mikael.starvik@axis.com> | 2005-07-27 14:44:44 -0400 |
---|---|---|
committer | Linus Torvalds <torvalds@g5.osdl.org> | 2005-07-27 19:26:01 -0400 |
commit | 51533b615e605d86154ec1b4e585c8ca1b0b15b7 (patch) | |
tree | 4a6d7d8494d2017632d83624fb71b36031e0e7e5 /arch/cris/arch-v32/kernel/head.S | |
parent | 5d01e6ce785884a5db5792cd2e5bb36fa82fe23c (diff) |
[PATCH] CRIS update: new subarchitecture v32
New CRIS sub architecture named v32.
From: Dave Jones <davej@redhat.com>
Fix swapped kmalloc args
Signed-off-by: Mikael Starvik <starvik@axis.com>
Signed-off-by: Dave Jones <davej@redhat.com>
Signed-off-by: Andrew Morton <akpm@osdl.org>
Signed-off-by: Linus Torvalds <torvalds@osdl.org>
Diffstat (limited to 'arch/cris/arch-v32/kernel/head.S')
-rw-r--r-- | arch/cris/arch-v32/kernel/head.S | 448 |
1 files changed, 448 insertions, 0 deletions
diff --git a/arch/cris/arch-v32/kernel/head.S b/arch/cris/arch-v32/kernel/head.S new file mode 100644 index 000000000000..3cfe57dc391d --- /dev/null +++ b/arch/cris/arch-v32/kernel/head.S | |||
@@ -0,0 +1,448 @@ | |||
1 | /* | ||
2 | * CRISv32 kernel startup code. | ||
3 | * | ||
4 | * Copyright (C) 2003, Axis Communications AB | ||
5 | */ | ||
6 | |||
7 | #include <linux/config.h> | ||
8 | |||
9 | #define ASSEMBLER_MACROS_ONLY | ||
10 | |||
11 | /* | ||
12 | * The macros found in mmu_defs_asm.h uses the ## concatenation operator, so | ||
13 | * -traditional must not be used when assembling this file. | ||
14 | */ | ||
15 | #include <asm/arch/hwregs/reg_rdwr.h> | ||
16 | #include <asm/arch/hwregs/asm/mmu_defs_asm.h> | ||
17 | #include <asm/arch/hwregs/asm/reg_map_asm.h> | ||
18 | #include <asm/arch/hwregs/asm/config_defs_asm.h> | ||
19 | #include <asm/arch/hwregs/asm/bif_core_defs_asm.h> | ||
20 | |||
21 | #define CRAMFS_MAGIC 0x28cd3d45 | ||
22 | #define RAM_INIT_MAGIC 0x56902387 | ||
23 | #define COMMAND_LINE_MAGIC 0x87109563 | ||
24 | |||
25 | ;; NOTE: R8 and R9 carry information from the decompressor (if the | ||
26 | ;; kernel was compressed). They must not be used in the code below | ||
27 | ;; until they are read! | ||
28 | |||
29 | ;; Exported symbols. | ||
30 | .global etrax_irv | ||
31 | .global romfs_start | ||
32 | .global romfs_length | ||
33 | .global romfs_in_flash | ||
34 | .global swapper_pg_dir | ||
35 | .global crisv32_nand_boot | ||
36 | .global crisv32_nand_cramfs_offset | ||
37 | |||
38 | ;; Dummy section to make it bootable with current VCS simulator | ||
39 | #ifdef CONFIG_ETRAXFS_SIM | ||
40 | .section ".boot", "ax" | ||
41 | ba tstart | ||
42 | nop | ||
43 | #endif | ||
44 | |||
45 | .text | ||
46 | tstart: | ||
47 | ;; This is the entry point of the kernel. The CPU is currently in | ||
48 | ;; supervisor mode. | ||
49 | ;; | ||
50 | ;; 0x00000000 if flash. | ||
51 | ;; 0x40004000 if DRAM. | ||
52 | ;; | ||
53 | di | ||
54 | |||
55 | ;; Start clocks for used blocks. | ||
56 | move.d REG_ADDR(config, regi_config, rw_clk_ctrl), $r1 | ||
57 | move.d [$r1], $r0 | ||
58 | or.d REG_STATE(config, rw_clk_ctrl, cpu, yes) | \ | ||
59 | REG_STATE(config, rw_clk_ctrl, bif, yes) | \ | ||
60 | REG_STATE(config, rw_clk_ctrl, fix_io, yes), $r0 | ||
61 | move.d $r0, [$r1] | ||
62 | |||
63 | ;; Set up waitstates etc | ||
64 | move.d REG_ADDR(bif_core, regi_bif_core, rw_grp1_cfg), $r0 | ||
65 | move.d CONFIG_ETRAX_MEM_GRP1_CONFIG, $r1 | ||
66 | move.d $r1, [$r0] | ||
67 | move.d REG_ADDR(bif_core, regi_bif_core, rw_grp2_cfg), $r0 | ||
68 | move.d CONFIG_ETRAX_MEM_GRP2_CONFIG, $r1 | ||
69 | move.d $r1, [$r0] | ||
70 | move.d REG_ADDR(bif_core, regi_bif_core, rw_grp3_cfg), $r0 | ||
71 | move.d CONFIG_ETRAX_MEM_GRP3_CONFIG, $r1 | ||
72 | move.d $r1, [$r0] | ||
73 | move.d REG_ADDR(bif_core, regi_bif_core, rw_grp4_cfg), $r0 | ||
74 | move.d CONFIG_ETRAX_MEM_GRP4_CONFIG, $r1 | ||
75 | move.d $r1, [$r0] | ||
76 | |||
77 | #ifdef CONFIG_ETRAXFS_SIM | ||
78 | ;; Set up minimal flash waitstates | ||
79 | move.d 0, $r10 | ||
80 | move.d REG_ADDR(bif_core, regi_bif_core, rw_grp1_cfg), $r11 | ||
81 | move.d $r10, [$r11] | ||
82 | #endif | ||
83 | |||
84 | ;; Setup and enable the MMU. Use same configuration for both the data | ||
85 | ;; and the instruction MMU. | ||
86 | ;; | ||
87 | ;; Note; 3 cycles is needed for a bank-select to take effect. Further; | ||
88 | ;; bank 1 is the instruction MMU, bank 2 is the data MMU. | ||
89 | #ifndef CONFIG_ETRAXFS_SIM | ||
90 | move.d REG_FIELD(mmu, rw_mm_kbase_hi, base_e, 8) \ | ||
91 | | REG_FIELD(mmu, rw_mm_kbase_hi, base_c, 4) \ | ||
92 | | REG_FIELD(mmu, rw_mm_kbase_hi, base_b, 0xb), $r0 | ||
93 | #else | ||
94 | ;; Map the virtual DRAM to the RW eprom area at address 0. | ||
95 | ;; Also map 0xa for the hook calls, | ||
96 | move.d REG_FIELD(mmu, rw_mm_kbase_hi, base_e, 8) \ | ||
97 | | REG_FIELD(mmu, rw_mm_kbase_hi, base_c, 0) \ | ||
98 | | REG_FIELD(mmu, rw_mm_kbase_hi, base_b, 0xb) \ | ||
99 | | REG_FIELD(mmu, rw_mm_kbase_hi, base_a, 0xa), $r0 | ||
100 | #endif | ||
101 | |||
102 | ;; Temporary map of 0x40 -> 0x40 and 0x00 -> 0x00. | ||
103 | move.d REG_FIELD(mmu, rw_mm_kbase_lo, base_4, 4) \ | ||
104 | | REG_FIELD(mmu, rw_mm_kbase_lo, base_0, 0), $r1 | ||
105 | |||
106 | ;; Enable certain page protections and setup linear mapping | ||
107 | ;; for f,e,c,b,4,0. | ||
108 | #ifndef CONFIG_ETRAXFS_SIM | ||
109 | move.d REG_STATE(mmu, rw_mm_cfg, we, on) \ | ||
110 | | REG_STATE(mmu, rw_mm_cfg, acc, on) \ | ||
111 | | REG_STATE(mmu, rw_mm_cfg, ex, on) \ | ||
112 | | REG_STATE(mmu, rw_mm_cfg, inv, on) \ | ||
113 | | REG_STATE(mmu, rw_mm_cfg, seg_f, linear) \ | ||
114 | | REG_STATE(mmu, rw_mm_cfg, seg_e, linear) \ | ||
115 | | REG_STATE(mmu, rw_mm_cfg, seg_d, page) \ | ||
116 | | REG_STATE(mmu, rw_mm_cfg, seg_c, linear) \ | ||
117 | | REG_STATE(mmu, rw_mm_cfg, seg_b, linear) \ | ||
118 | | REG_STATE(mmu, rw_mm_cfg, seg_a, page) \ | ||
119 | | REG_STATE(mmu, rw_mm_cfg, seg_9, page) \ | ||
120 | | REG_STATE(mmu, rw_mm_cfg, seg_8, page) \ | ||
121 | | REG_STATE(mmu, rw_mm_cfg, seg_7, page) \ | ||
122 | | REG_STATE(mmu, rw_mm_cfg, seg_6, page) \ | ||
123 | | REG_STATE(mmu, rw_mm_cfg, seg_5, page) \ | ||
124 | | REG_STATE(mmu, rw_mm_cfg, seg_4, linear) \ | ||
125 | | REG_STATE(mmu, rw_mm_cfg, seg_3, page) \ | ||
126 | | REG_STATE(mmu, rw_mm_cfg, seg_2, page) \ | ||
127 | | REG_STATE(mmu, rw_mm_cfg, seg_1, page) \ | ||
128 | | REG_STATE(mmu, rw_mm_cfg, seg_0, linear), $r2 | ||
129 | #else | ||
130 | move.d REG_STATE(mmu, rw_mm_cfg, we, on) \ | ||
131 | | REG_STATE(mmu, rw_mm_cfg, acc, on) \ | ||
132 | | REG_STATE(mmu, rw_mm_cfg, ex, on) \ | ||
133 | | REG_STATE(mmu, rw_mm_cfg, inv, on) \ | ||
134 | | REG_STATE(mmu, rw_mm_cfg, seg_f, linear) \ | ||
135 | | REG_STATE(mmu, rw_mm_cfg, seg_e, linear) \ | ||
136 | | REG_STATE(mmu, rw_mm_cfg, seg_d, page) \ | ||
137 | | REG_STATE(mmu, rw_mm_cfg, seg_c, linear) \ | ||
138 | | REG_STATE(mmu, rw_mm_cfg, seg_b, linear) \ | ||
139 | | REG_STATE(mmu, rw_mm_cfg, seg_a, linear) \ | ||
140 | | REG_STATE(mmu, rw_mm_cfg, seg_9, page) \ | ||
141 | | REG_STATE(mmu, rw_mm_cfg, seg_8, page) \ | ||
142 | | REG_STATE(mmu, rw_mm_cfg, seg_7, page) \ | ||
143 | | REG_STATE(mmu, rw_mm_cfg, seg_6, page) \ | ||
144 | | REG_STATE(mmu, rw_mm_cfg, seg_5, page) \ | ||
145 | | REG_STATE(mmu, rw_mm_cfg, seg_4, linear) \ | ||
146 | | REG_STATE(mmu, rw_mm_cfg, seg_3, page) \ | ||
147 | | REG_STATE(mmu, rw_mm_cfg, seg_2, page) \ | ||
148 | | REG_STATE(mmu, rw_mm_cfg, seg_1, page) \ | ||
149 | | REG_STATE(mmu, rw_mm_cfg, seg_0, linear), $r2 | ||
150 | #endif | ||
151 | |||
152 | ;; Update instruction MMU. | ||
153 | move 1, $srs | ||
154 | nop | ||
155 | nop | ||
156 | nop | ||
157 | move $r0, $s2 ; kbase_hi. | ||
158 | move $r1, $s1 ; kbase_lo. | ||
159 | move $r2, $s0 ; mm_cfg, virtual memory configuration. | ||
160 | |||
161 | ;; Update data MMU. | ||
162 | move 2, $srs | ||
163 | nop | ||
164 | nop | ||
165 | nop | ||
166 | move $r0, $s2 ; kbase_hi. | ||
167 | move $r1, $s1 ; kbase_lo | ||
168 | move $r2, $s0 ; mm_cfg, virtual memory configuration. | ||
169 | |||
170 | ;; Enable data and instruction MMU. | ||
171 | move 0, $srs | ||
172 | moveq 0xf, $r0 ; IMMU, DMMU, DCache, Icache on | ||
173 | nop | ||
174 | nop | ||
175 | nop | ||
176 | move $r0, $s0 | ||
177 | nop | ||
178 | nop | ||
179 | nop | ||
180 | |||
181 | #ifdef CONFIG_SMP | ||
182 | ;; Read CPU ID | ||
183 | move 0, $srs | ||
184 | nop | ||
185 | nop | ||
186 | nop | ||
187 | move $s10, $r0 | ||
188 | cmpq 0, $r0 | ||
189 | beq master_cpu | ||
190 | nop | ||
191 | slave_cpu: | ||
192 | ; A slave waits for cpu_now_booting to be equal to CPU ID. | ||
193 | move.d cpu_now_booting, $r1 | ||
194 | slave_wait: | ||
195 | cmp.d [$r1], $r0 | ||
196 | bne slave_wait | ||
197 | nop | ||
198 | ; Time to boot-up. Get stack location provided by master CPU. | ||
199 | move.d smp_init_current_idle_thread, $r1 | ||
200 | move.d [$r1], $sp | ||
201 | add.d 8192, $sp | ||
202 | move.d ebp_start, $r0 ; Defined in linker-script. | ||
203 | move $r0, $ebp | ||
204 | jsr smp_callin | ||
205 | nop | ||
206 | master_cpu: | ||
207 | #endif | ||
208 | #ifndef CONFIG_ETRAXFS_SIM | ||
209 | ;; Check if starting from DRAM or flash. | ||
210 | lapcq ., $r0 | ||
211 | and.d 0x7fffffff, $r0 ; Mask off the non-cache bit. | ||
212 | cmp.d 0x10000, $r0 ; Arbitrary, something above this code. | ||
213 | blo _inflash0 | ||
214 | nop | ||
215 | #endif | ||
216 | |||
217 | jump _inram ; Jump to cached RAM. | ||
218 | nop | ||
219 | |||
220 | ;; Jumpgate. | ||
221 | _inflash0: | ||
222 | jump _inflash | ||
223 | nop | ||
224 | |||
225 | ;; Put the following in a section so that storage for it can be | ||
226 | ;; reclaimed after init is finished. | ||
227 | .section ".init.text", "ax" | ||
228 | |||
229 | _inflash: | ||
230 | |||
231 | ;; Initialize DRAM. | ||
232 | cmp.d RAM_INIT_MAGIC, $r8 ; Already initialized? | ||
233 | beq _dram_initialized | ||
234 | nop | ||
235 | |||
236 | #include "../lib/dram_init.S" | ||
237 | |||
238 | _dram_initialized: | ||
239 | ;; Copy the text and data section to DRAM. This depends on that the | ||
240 | ;; variables used below are correctly set up by the linker script. | ||
241 | ;; The calculated value stored in R4 is used below. | ||
242 | moveq 0, $r0 ; Source. | ||
243 | move.d text_start, $r1 ; Destination. | ||
244 | move.d __vmlinux_end, $r2 | ||
245 | move.d $r2, $r4 | ||
246 | sub.d $r1, $r4 | ||
247 | 1: move.w [$r0+], $r3 | ||
248 | move.w $r3, [$r1+] | ||
249 | cmp.d $r2, $r1 | ||
250 | blo 1b | ||
251 | nop | ||
252 | |||
253 | ;; Keep CRAMFS in flash. | ||
254 | moveq 0, $r0 | ||
255 | move.d romfs_length, $r1 | ||
256 | move.d $r0, [$r1] | ||
257 | move.d [$r4], $r0 ; cramfs_super.magic | ||
258 | cmp.d CRAMFS_MAGIC, $r0 | ||
259 | bne 1f | ||
260 | nop | ||
261 | |||
262 | addoq +4, $r4, $acr | ||
263 | move.d [$acr], $r0 | ||
264 | move.d romfs_length, $r1 | ||
265 | move.d $r0, [$r1] | ||
266 | add.d 0xf0000000, $r4 ; Add cached flash start in virtual memory. | ||
267 | move.d romfs_start, $r1 | ||
268 | move.d $r4, [$r1] | ||
269 | 1: moveq 1, $r0 | ||
270 | move.d romfs_in_flash, $r1 | ||
271 | move.d $r0, [$r1] | ||
272 | |||
273 | jump _start_it ; Jump to cached code. | ||
274 | nop | ||
275 | |||
276 | _inram: | ||
277 | ;; Check if booting from NAND flash (in that case we just remember the offset | ||
278 | ;; into the flash where cramfs should be). | ||
279 | move.d REG_ADDR(config, regi_config, r_bootsel), $r0 | ||
280 | move.d [$r0], $r0 | ||
281 | and.d REG_MASK(config, r_bootsel, boot_mode), $r0 | ||
282 | cmp.d REG_STATE(config, r_bootsel, boot_mode, nand), $r0 | ||
283 | bne move_cramfs | ||
284 | moveq 1,$r0 | ||
285 | move.d crisv32_nand_boot, $r1 | ||
286 | move.d $r0, [$r1] | ||
287 | move.d crisv32_nand_cramfs_offset, $r1 | ||
288 | move.d $r9, [$r1] | ||
289 | moveq 1, $r0 | ||
290 | move.d romfs_in_flash, $r1 | ||
291 | move.d $r0, [$r1] | ||
292 | jump _start_it | ||
293 | nop | ||
294 | |||
295 | move_cramfs: | ||
296 | ;; Move the cramfs after BSS. | ||
297 | moveq 0, $r0 | ||
298 | move.d romfs_length, $r1 | ||
299 | move.d $r0, [$r1] | ||
300 | |||
301 | #ifndef CONFIG_ETRAXFS_SIM | ||
302 | ;; The kernel could have been unpacked to DRAM by the loader, but | ||
303 | ;; the cramfs image could still be inte the flash immediately | ||
304 | ;; following the compressed kernel image. The loaded passes the address | ||
305 | ;; of the bute succeeding the last compressed byte in the flash in | ||
306 | ;; register R9 when starting the kernel. | ||
307 | cmp.d 0x0ffffff8, $r9 | ||
308 | bhs _no_romfs_in_flash ; R9 points outside the flash area. | ||
309 | nop | ||
310 | #else | ||
311 | ba _no_romfs_in_flash | ||
312 | nop | ||
313 | #endif | ||
314 | move.d [$r9], $r0 ; cramfs_super.magic | ||
315 | cmp.d CRAMFS_MAGIC, $r0 | ||
316 | bne _no_romfs_in_flash | ||
317 | nop | ||
318 | |||
319 | addoq +4, $r9, $acr | ||
320 | move.d [$acr], $r0 | ||
321 | move.d romfs_length, $r1 | ||
322 | move.d $r0, [$r1] | ||
323 | add.d 0xf0000000, $r9 ; Add cached flash start in virtual memory. | ||
324 | move.d romfs_start, $r1 | ||
325 | move.d $r9, [$r1] | ||
326 | moveq 1, $r0 | ||
327 | move.d romfs_in_flash, $r1 | ||
328 | move.d $r0, [$r1] | ||
329 | |||
330 | jump _start_it ; Jump to cached code. | ||
331 | nop | ||
332 | |||
333 | _no_romfs_in_flash: | ||
334 | ;; Look for cramfs. | ||
335 | #ifndef CONFIG_ETRAXFS_SIM | ||
336 | move.d __vmlinux_end, $r0 | ||
337 | #else | ||
338 | move.d __end, $r0 | ||
339 | #endif | ||
340 | move.d [$r0], $r1 | ||
341 | cmp.d CRAMFS_MAGIC, $r1 | ||
342 | bne 2f | ||
343 | nop | ||
344 | |||
345 | addoq +4, $r0, $acr | ||
346 | move.d [$acr], $r2 | ||
347 | move.d _end, $r1 | ||
348 | move.d romfs_start, $r3 | ||
349 | move.d $r1, [$r3] | ||
350 | move.d romfs_length, $r3 | ||
351 | move.d $r2, [$r3] | ||
352 | |||
353 | #ifndef CONFIG_ETRAXFS_SIM | ||
354 | add.d $r2, $r0 | ||
355 | add.d $r2, $r1 | ||
356 | |||
357 | lsrq 1, $r2 ; Size is in bytes, we copy words. | ||
358 | addq 1, $r2 | ||
359 | 1: | ||
360 | move.w [$r0], $r3 | ||
361 | move.w $r3, [$r1] | ||
362 | subq 2, $r0 | ||
363 | subq 2, $r1 | ||
364 | subq 1, $r2 | ||
365 | bne 1b | ||
366 | nop | ||
367 | #endif | ||
368 | |||
369 | 2: | ||
370 | moveq 0, $r0 | ||
371 | move.d romfs_in_flash, $r1 | ||
372 | move.d $r0, [$r1] | ||
373 | |||
374 | jump _start_it ; Jump to cached code. | ||
375 | nop | ||
376 | |||
377 | _start_it: | ||
378 | |||
379 | ;; Check if kernel command line is supplied | ||
380 | cmp.d COMMAND_LINE_MAGIC, $r10 | ||
381 | bne no_command_line | ||
382 | nop | ||
383 | |||
384 | move.d 256, $r13 | ||
385 | move.d cris_command_line, $r10 | ||
386 | or.d 0x80000000, $r11 ; Make it virtual | ||
387 | 1: | ||
388 | move.b [$r11+], $r12 | ||
389 | move.b $r12, [$r10+] | ||
390 | subq 1, $r13 | ||
391 | bne 1b | ||
392 | nop | ||
393 | |||
394 | no_command_line: | ||
395 | |||
396 | ;; The kernel stack contains a task structure for each task. This | ||
397 | ;; the initial kernel stack is in the same page as the init_task, | ||
398 | ;; but starts at the top of the page, i.e. + 8192 bytes. | ||
399 | move.d init_thread_union + 8192, $sp | ||
400 | move.d ebp_start, $r0 ; Defined in linker-script. | ||
401 | move $r0, $ebp | ||
402 | move.d etrax_irv, $r1 ; Set the exception base register and pointer. | ||
403 | move.d $r0, [$r1] | ||
404 | |||
405 | #ifndef CONFIG_ETRAXFS_SIM | ||
406 | ;; Clear the BSS region from _bss_start to _end. | ||
407 | move.d __bss_start, $r0 | ||
408 | move.d _end, $r1 | ||
409 | 1: clear.d [$r0+] | ||
410 | cmp.d $r1, $r0 | ||
411 | blo 1b | ||
412 | nop | ||
413 | #endif | ||
414 | |||
415 | #ifdef CONFIG_ETRAXFS_SIM | ||
416 | /* Set the watchdog timeout to something big. Will be removed when */ | ||
417 | /* watchdog can be disabled with command line option */ | ||
418 | move.d 0x7fffffff, $r10 | ||
419 | jsr CPU_WATCHDOG_TIMEOUT | ||
420 | nop | ||
421 | #endif | ||
422 | |||
423 | ; Initialize registers to increase determinism | ||
424 | move.d __bss_start, $r0 | ||
425 | movem [$r0], $r13 | ||
426 | |||
427 | jump start_kernel ; Jump to start_kernel() in init/main.c. | ||
428 | nop | ||
429 | |||
430 | .data | ||
431 | etrax_irv: | ||
432 | .dword 0 | ||
433 | romfs_start: | ||
434 | .dword 0 | ||
435 | romfs_length: | ||
436 | .dword 0 | ||
437 | romfs_in_flash: | ||
438 | .dword 0 | ||
439 | crisv32_nand_boot: | ||
440 | .dword 0 | ||
441 | crisv32_nand_cramfs_offset: | ||
442 | .dword 0 | ||
443 | |||
444 | swapper_pg_dir = 0xc0002000 | ||
445 | |||
446 | .section ".init.data", "aw" | ||
447 | |||
448 | #include "../lib/hw_settings.S" | ||