1 /* btfixup.c: Boot time code fixup and relocator, so that
2 * we can get rid of most indirect calls to achieve single
3 * image sun4c and srmmu kernel.
5 * Copyright (C) 1998 Jakub Jelinek (jj@sunsite.mff.cuni.cz)
8 #include <linux/kernel.h>
9 #include <linux/init.h>
10 #include <asm/btfixup.h>
12 #include <asm/pgalloc.h>
13 #include <asm/pgtable.h>
14 #include <asm/oplib.h>
15 #include <asm/cacheflush.h>
17 #define BTFIXUP_OPTIMIZE_NOP
18 #define BTFIXUP_OPTIMIZE_OTHER
20 extern char *srmmu_name
;
21 static char version
[] __initdata
= "Boot time fixup v1.6. 4/Mar/98 Jakub Jelinek (jj@ultra.linux.cz). Patching kernel for ";
22 static char str_sun4c
[] __initdata
= "sun4c\n";
23 static char str_srmmu
[] __initdata
= "srmmu[%s]/";
24 static char str_iommu
[] __initdata
= "iommu\n";
25 static char str_iounit
[] __initdata
= "io-unit\n";
27 static int visited __initdata
= 0;
28 extern unsigned int ___btfixup_start
[], ___btfixup_end
[], __init_begin
[], __init_end
[], __init_text_end
[];
29 extern unsigned int _stext
[], _end
[], __start___ksymtab
[], __stop___ksymtab
[];
30 static char wrong_f
[] __initdata
= "Trying to set f fixup %p to invalid function %08x\n";
31 static char wrong_b
[] __initdata
= "Trying to set b fixup %p to invalid function %08x\n";
32 static char wrong_s
[] __initdata
= "Trying to set s fixup %p to invalid value %08x\n";
33 static char wrong_h
[] __initdata
= "Trying to set h fixup %p to invalid value %08x\n";
34 static char wrong_a
[] __initdata
= "Trying to set a fixup %p to invalid value %08x\n";
35 static char wrong
[] __initdata
= "Wrong address for %c fixup %p\n";
36 static char insn_f
[] __initdata
= "Fixup f %p refers to weird instructions at %p[%08x,%08x]\n";
37 static char insn_b
[] __initdata
= "Fixup b %p doesn't refer to a SETHI at %p[%08x]\n";
38 static char insn_s
[] __initdata
= "Fixup s %p doesn't refer to an OR at %p[%08x]\n";
39 static char insn_h
[] __initdata
= "Fixup h %p doesn't refer to a SETHI at %p[%08x]\n";
40 static char insn_a
[] __initdata
= "Fixup a %p doesn't refer to a SETHI nor OR at %p[%08x]\n";
41 static char insn_i
[] __initdata
= "Fixup i %p doesn't refer to a valid instruction at %p[%08x]\n";
42 static char fca_und
[] __initdata
= "flush_cache_all undefined in btfixup()\n";
43 static char wrong_setaddr
[] __initdata
= "Garbled CALL/INT patch at %p[%08x,%08x,%08x]=%08x\n";
45 #ifdef BTFIXUP_OPTIMIZE_OTHER
46 static void __init
set_addr(unsigned int *addr
, unsigned int q1
, int fmangled
, unsigned int value
)
51 unsigned int *q
= (unsigned int *)q1
;
52 if (*addr
== 0x01000000) {
55 } else if (addr
[-1] == *q
) {
60 prom_printf(wrong_setaddr
, addr
-1, addr
[-1], *addr
, *q
, value
);
66 static inline void set_addr(unsigned int *addr
, unsigned int q1
, int fmangled
, unsigned int value
)
72 void __init
btfixup(void)
79 void (*flush_cacheall
)(void);
87 printk(str_srmmu
, srmmu_name
);
88 if (sparc_cpu_model
== sun4d
)
94 for (p
= ___btfixup_start
; p
< ___btfixup_end
; ) {
97 switch (type
= *(unsigned char *)p
) {
101 if (((p
[0] & 1) || p
[1])
102 && ((p
[1] & 3) || (unsigned *)(p
[1]) < _stext
|| (unsigned *)(p
[1]) >= _end
)) {
103 prom_printf(wrong_f
, p
, p
[1]);
108 if (p
[1] < (unsigned long)__init_begin
|| p
[1] >= (unsigned long)__init_text_end
|| (p
[1] & 3)) {
109 prom_printf(wrong_b
, p
, p
[1]);
114 if (p
[1] + 0x1000 >= 0x2000) {
115 prom_printf(wrong_s
, p
, p
[1]);
121 prom_printf(wrong_h
, p
, p
[1]);
126 if (p
[1] + 0x1000 >= 0x2000 && (p
[1] & 0x3ff)) {
127 prom_printf(wrong_a
, p
, p
[1]);
136 addr
= (unsigned *)*q
;
137 if (addr
< _stext
|| addr
>= _end
) {
138 prom_printf(wrong
, type
, p
);
142 #ifdef BTFIXUP_OPTIMIZE_OTHER
143 if (type
!= 'f' && q
[1]) {
144 insn
= *(unsigned int *)q
[1];
145 if (!insn
|| insn
== 1)
153 if (addr
>= __start___ksymtab
&& addr
< __stop___ksymtab
) {
157 if ((insn
& 0xc1c00000) == 0x01000000) { /* SETHI */
158 *addr
= (insn
& 0xffc00000) | (p
[1] >> 10); break;
159 } else if ((insn
& 0xc1f82000) == 0x80102000) { /* OR X, %LO(i), Y */
160 *addr
= (insn
& 0xffffe000) | (p
[1] & 0x3ff); break;
161 } else if ((insn
& 0xc0000000) != 0x40000000) { /* !CALL */
163 prom_printf(insn_f
, p
, addr
, insn
, addr
[1]);
166 } else if (q
[1] != 1)
168 if (p
[2] == BTFIXUPCALL_NORM
) {
170 *addr
= 0x40000000 | ((p
[1] - (unsigned)addr
) >> 2);
174 #ifndef BTFIXUP_OPTIMIZE_NOP
177 if (!(addr
[1] & 0x80000000)) {
178 if ((addr
[1] & 0xc1c00000) != 0x01000000) /* !SETHI */
179 goto bad_f
; /* CALL, Bicc, FBfcc, CBccc are weird in delay slot, aren't they? */
181 if ((addr
[1] & 0x01800000) == 0x01800000) {
182 if ((addr
[1] & 0x01f80000) == 0x01e80000) {
184 goto norm_f
; /* It is dangerous to patch that */
188 if ((addr
[1] & 0xffffe003) == 0x9e03e000) {
189 /* ADD %O7, XX, %o7 */
190 int displac
= (addr
[1] << 19);
192 displac
= (displac
>> 21) + 2;
193 *addr
= (0x10800000) + (displac
& 0x3fffff);
198 if ((addr
[1] & 0x201f) == 0x200f || (addr
[1] & 0x7c000) == 0x3c000)
199 goto norm_f
; /* Someone is playing bad tricks with us: rs1 or rs2 is o7 */
200 if ((addr
[1] & 0x3e000000) == 0x1e000000)
201 goto norm_f
; /* rd is %o7. We'd better take care. */
203 if (p
[2] == BTFIXUPCALL_NOP
) {
208 #ifndef BTFIXUP_OPTIMIZE_OTHER
211 if (addr
[1] == 0x01000000) { /* NOP in the delay slot */
216 if ((addr
[1] & 0xc0000000) != 0xc0000000) {
217 /* Not a memory operation */
218 if ((addr
[1] & 0x30000000) == 0x10000000) {
219 /* Ok, non-memory op with rd %oX */
220 if ((addr
[1] & 0x3e000000) == 0x1c000000)
221 goto bad_f
; /* Aiee. Someone is playing strange %sp tricks */
222 if ((addr
[1] & 0x3e000000) > 0x12000000 ||
223 ((addr
[1] & 0x3e000000) == 0x12000000 &&
224 p
[2] != BTFIXUPCALL_STO1O0
&& p
[2] != BTFIXUPCALL_SWAPO0O1
) ||
225 ((p
[2] & 0xffffe000) == BTFIXUPCALL_RETINT(0))) {
226 /* Nobody uses the result. We can nop it out. */
229 addr
[1] = 0x01000000;
232 if ((addr
[1] & 0xf1ffffe0) == 0x90100000) {
234 if ((addr
[1] & 0x3e000000) == 0x10000000 &&
235 (p
[2] & 0x7c000) == 0x20000) {
236 /* Ok, it is call xx; mov reg, %o0 and call optimizes
237 to doing something on %o0. Patch the patch. */
238 *addr
= (p
[2] & ~0x7c000) | ((addr
[1] & 0x1f) << 14);
240 addr
[1] = 0x01000000;
243 if ((addr
[1] & 0x3e000000) == 0x12000000 &&
244 p
[2] == BTFIXUPCALL_STO1O0
) {
245 *addr
= (p
[2] & ~0x3e000000) | ((addr
[1] & 0x1f) << 25);
247 addr
[1] = 0x01000000;
257 #endif /* BTFIXUP_OPTIMIZE_OTHER */
258 #endif /* BTFIXUP_OPTIMIZE_NOP */
259 case 'b': /* BLACKBOX */
260 /* Has to be sethi i, xx */
261 if ((insn
& 0xc1c00000) != 0x01000000) {
262 prom_printf(insn_b
, p
, addr
, insn
);
265 void (*do_fixup
)(unsigned *);
267 do_fixup
= (void (*)(unsigned *))p
[1];
271 case 's': /* SIMM13 */
272 /* Has to be or %g0, i, xx */
273 if ((insn
& 0xc1ffe000) != 0x80102000) {
274 prom_printf(insn_s
, p
, addr
, insn
);
277 set_addr(addr
, q
[1], fmangled
, (insn
& 0xffffe000) | (p
[1] & 0x1fff));
279 case 'h': /* SETHI */
280 /* Has to be sethi i, xx */
281 if ((insn
& 0xc1c00000) != 0x01000000) {
282 prom_printf(insn_h
, p
, addr
, insn
);
285 set_addr(addr
, q
[1], fmangled
, (insn
& 0xffc00000) | (p
[1] >> 10));
288 /* Has to be sethi i, xx or or %g0, i, xx */
289 if ((insn
& 0xc1c00000) != 0x01000000 &&
290 (insn
& 0xc1ffe000) != 0x80102000) {
291 prom_printf(insn_a
, p
, addr
, insn
);
295 set_addr(addr
, q
[1], fmangled
,
296 (insn
& 0x3e000000) | 0x80102000 | (p
[1] & 0x1fff));
298 set_addr(addr
, q
[1], fmangled
,
299 (insn
& 0x3e000000) | 0x01000000 | (p
[1] >> 10));
302 if ((insn
& 0xc1c00000) == 0x01000000) /* %HI */
303 set_addr(addr
, q
[1], fmangled
, (insn
& 0xffc00000) | (p
[1] >> 10));
304 else if ((insn
& 0x80002000) == 0x80002000) /* %LO */
305 set_addr(addr
, q
[1], fmangled
, (insn
& 0xffffe000) | (p
[1] & 0x3ff));
307 prom_printf(insn_i
, p
, addr
, insn
);
319 flush_cacheall
= (void (*)(void))BTFIXUPVAL_CALL(local_flush_cache_all
);
321 flush_cacheall
= (void (*)(void))BTFIXUPVAL_CALL(flush_cache_all
);
323 if (!flush_cacheall
) {
324 prom_printf(fca_und
);