Commit | Line | Data |
---|---|---|
b2441318 | 1 | /* SPDX-License-Identifier: GPL-2.0 */ |
1da177e4 LT |
2 | /* |
3 | * linux/arch/m32r/boot/compressed/head.S | |
4 | * | |
5 | * Copyright (c) 2001-2003 Hiroyuki Kondo, Hirokazu Takata, | |
6 | * Hitoshi Yamamoto, Takeo Takahashi | |
7 | * Copyright (c) 2004 Hirokazu Takata | |
8 | */ | |
9 | ||
10 | .text | |
1da177e4 LT |
11 | #include <linux/linkage.h> |
12 | #include <asm/addrspace.h> | |
13 | #include <asm/page.h> | |
14 | #include <asm/assembler.h> | |
15 | ||
16 | /* | |
17 | * This code can be loaded anywhere, as long as output will not | |
18 | * overlap it. | |
19 | * | |
20 | * NOTE: This head.S should *NOT* be compiled with -fpic. | |
21 | * | |
22 | */ | |
23 | ||
24 | .global startup | |
25 | .global __bss_start, _ebss, end, zimage_data, zimage_len | |
26 | __ALIGN | |
27 | startup: | |
28 | ldi r0, #0x0000 /* SPI, disable EI */ | |
29 | mvtc r0, psw | |
30 | ||
31 | ldi r12, #-8 | |
32 | bl 1f | |
33 | .fillinsn | |
34 | 1: | |
35 | seth r1, #high(CONFIG_MEMORY_START + 0x00400000) /* Start address */ | |
36 | add r12, r14 /* Real address */ | |
37 | sub r12, r1 /* difference */ | |
38 | ||
39 | .global got_len | |
40 | seth r3, #high(_GLOBAL_OFFSET_TABLE_+8) | |
41 | or3 r3, r3, #low(_GLOBAL_OFFSET_TABLE_+12) | |
42 | add r3, r14 | |
43 | ||
44 | /* Update the contents of global offset table */ | |
45 | ldi r1, #low(got_len) | |
46 | srli r1, #2 | |
47 | beqz r1, 2f | |
48 | .fillinsn | |
49 | 1: | |
50 | ld r2, @r3 | |
51 | add r2, r12 | |
52 | st r2, @r3 | |
53 | addi r3, #4 | |
54 | addi r1, #-1 | |
55 | bnez r1, 1b | |
56 | .fillinsn | |
57 | 2: | |
58 | /* XXX: resolve plt */ | |
59 | ||
60 | /* | |
61 | * Clear BSS first so that there are no surprises... | |
62 | */ | |
63 | #ifdef CONFIG_ISA_DUAL_ISSUE | |
64 | seth r2, #high(__bss_start) | |
65 | or3 r2, r2, #low(__bss_start) | |
66 | add r2, r12 | |
67 | seth r3, #high(_ebss) | |
68 | or3 r3, r3, #low(_ebss) | |
69 | add r3, r12 | |
70 | sub r3, r2 | |
71 | ||
72 | ; R4 = BSS size in longwords (rounded down) | |
73 | mv r4, r3 || ldi r1, #0 | |
74 | srli r4, #4 || addi r2, #-4 | |
75 | beqz r4, .Lendloop1 | |
76 | .Lloop1: | |
77 | #ifndef CONFIG_CHIP_M32310 | |
78 | ; Touch memory for the no-write-allocating cache. | |
79 | ld r0, @(4,r2) | |
80 | #endif | |
81 | st r1, @+r2 || addi r4, #-1 | |
82 | st r1, @+r2 | |
83 | st r1, @+r2 | |
84 | st r1, @+r2 || cmpeq r1, r4 ; R4 = 0? | |
85 | bnc .Lloop1 | |
86 | .Lendloop1: | |
87 | and3 r4, r3, #15 | |
88 | addi r2, #4 | |
89 | beqz r4, .Lendloop2 | |
90 | .Lloop2: | |
91 | stb r1, @r2 || addi r4, #-1 | |
92 | addi r2, #1 | |
93 | bnez r4, .Lloop2 | |
94 | .Lendloop2: | |
95 | ||
96 | #else /* not CONFIG_ISA_DUAL_ISSUE */ | |
97 | seth r2, #high(__bss_start) | |
98 | or3 r2, r2, #low(__bss_start) | |
99 | add r2, r12 | |
100 | seth r3, #high(_ebss) | |
101 | or3 r3, r3, #low(_ebss) | |
102 | add r3, r12 | |
103 | sub r3, r2 | |
104 | mv r4, r3 | |
105 | srli r4, #2 ; R4 = BSS size in longwords (rounded down) | |
106 | ldi r1, #0 ; clear R1 for longwords store | |
107 | addi r2, #-4 ; account for pre-inc store | |
108 | beqz r4, .Lendloop1 ; any more to go? | |
109 | .Lloop1: | |
110 | st r1, @+r2 ; yep, zero out another longword | |
111 | addi r4, #-1 ; decrement count | |
112 | bnez r4, .Lloop1 ; go do some more | |
113 | .Lendloop1: | |
114 | ||
115 | #endif /* not CONFIG_ISA_DUAL_ISSUE */ | |
116 | ||
117 | seth r1, #high(end) | |
118 | or3 r1, r1, #low(end) | |
119 | add r1, r12 | |
120 | mv sp, r1 | |
121 | ||
122 | /* | |
123 | * decompress the kernel | |
124 | */ | |
125 | mv r0, sp | |
126 | srli r0, 31 /* MMU is ON or OFF */ | |
127 | seth r1, #high(zimage_data) | |
128 | or3 r1, r1, #low(zimage_data) | |
129 | add r1, r12 | |
130 | seth r2, #high(zimage_len) | |
131 | or3 r2, r2, #low(zimage_len) | |
132 | mv r3, sp | |
133 | ||
134 | bl decompress_kernel | |
135 | ||
136 | #if defined(CONFIG_CHIP_M32700) || defined(CONFIG_CHIP_OPSP) || defined(CONFIG_CHIP_VDEC2) | |
137 | /* Cache flush */ | |
138 | ldi r0, -1 | |
139 | ldi r1, 0xd0 ; invalidate i-cache, copy back d-cache | |
140 | stb r1, @r0 | |
141 | #elif defined(CONFIG_CHIP_M32102) | |
142 | /* Cache flush */ | |
143 | ldi r0, -2 | |
144 | ldi r1, 0x0100 ; invalidate | |
145 | stb r1, @r0 | |
9287d95e HT |
146 | #elif defined(CONFIG_CHIP_M32104) |
147 | /* Cache flush */ | |
148 | ldi r0, -2 | |
149 | ldi r1, 0x0700 ; invalidate i-cache, copy back d-cache | |
150 | sth r1, @r0 | |
1da177e4 LT |
151 | #else |
152 | #error "put your cache flush function, please" | |
153 | #endif | |
154 | ||
155 | mv r0, sp | |
156 | srli r0, 31 /* MMU is ON or OFF */ | |
157 | slli r0, 31 | |
158 | or3 r0, r0, #0x2000 | |
159 | seth r1, #high(CONFIG_MEMORY_START) | |
160 | or r0, r1 | |
161 | jmp r0 | |
162 | ||
163 | .balign 512 | |
164 | fake_headers_as_bzImage: | |
165 | .short 0 | |
166 | .ascii "HdrS" | |
167 | .short 0x0202 | |
168 | .short 0 | |
169 | .short 0 | |
170 | .byte 0x00, 0x10 | |
171 | .short 0 | |
172 | .byte 0 | |
173 | .byte 1 | |
174 | .byte 0x00, 0x80 | |
175 | .long 0 | |
176 | .long 0 | |
177 |