| /* btfixup.c: Boot time code fixup and relocator, so that |
| * we can get rid of most indirect calls to achieve single |
| * image sun4c and srmmu kernel. |
| * |
| * Copyright (C) 1998 Jakub Jelinek (jj@sunsite.mff.cuni.cz) |
| */ |
| |
| #include <linux/kernel.h> |
| #include <linux/init.h> |
| #include <asm/btfixup.h> |
| #include <asm/page.h> |
| #include <asm/pgalloc.h> |
| #include <asm/pgtable.h> |
| #include <asm/oplib.h> |
| #include <asm/system.h> |
| #include <asm/cacheflush.h> |
| |
| #define BTFIXUP_OPTIMIZE_NOP |
| #define BTFIXUP_OPTIMIZE_OTHER |
| |
| extern char *srmmu_name; |
| static char version[] __initdata = "Boot time fixup v1.6. 4/Mar/98 Jakub Jelinek (jj@ultra.linux.cz). Patching kernel for "; |
| static char str_sun4c[] __initdata = "sun4c\n"; |
| static char str_srmmu[] __initdata = "srmmu[%s]/"; |
| static char str_iommu[] __initdata = "iommu\n"; |
| static char str_iounit[] __initdata = "io-unit\n"; |
| |
| static int visited __initdata = 0; |
| extern unsigned int ___btfixup_start[], ___btfixup_end[], __init_begin[], __init_end[], __init_text_end[]; |
| extern unsigned int _stext[], _end[], __start___ksymtab[], __stop___ksymtab[]; |
| static char wrong_f[] __initdata = "Trying to set f fixup %p to invalid function %08x\n"; |
| static char wrong_b[] __initdata = "Trying to set b fixup %p to invalid function %08x\n"; |
| static char wrong_s[] __initdata = "Trying to set s fixup %p to invalid value %08x\n"; |
| static char wrong_h[] __initdata = "Trying to set h fixup %p to invalid value %08x\n"; |
| static char wrong_a[] __initdata = "Trying to set a fixup %p to invalid value %08x\n"; |
| static char wrong[] __initdata = "Wrong address for %c fixup %p\n"; |
| static char insn_f[] __initdata = "Fixup f %p refers to weird instructions at %p[%08x,%08x]\n"; |
| static char insn_b[] __initdata = "Fixup b %p doesn't refer to a SETHI at %p[%08x]\n"; |
| static char insn_s[] __initdata = "Fixup s %p doesn't refer to an OR at %p[%08x]\n"; |
| static char insn_h[] __initdata = "Fixup h %p doesn't refer to a SETHI at %p[%08x]\n"; |
| static char insn_a[] __initdata = "Fixup a %p doesn't refer to a SETHI nor OR at %p[%08x]\n"; |
| static char insn_i[] __initdata = "Fixup i %p doesn't refer to a valid instruction at %p[%08x]\n"; |
| static char fca_und[] __initdata = "flush_cache_all undefined in btfixup()\n"; |
| static char wrong_setaddr[] __initdata = "Garbled CALL/INT patch at %p[%08x,%08x,%08x]=%08x\n"; |
| |
| #ifdef BTFIXUP_OPTIMIZE_OTHER |
| static void __init set_addr(unsigned int *addr, unsigned int q1, int fmangled, unsigned int value) |
| { |
| if (!fmangled) |
| *addr = value; |
| else { |
| unsigned int *q = (unsigned int *)q1; |
| if (*addr == 0x01000000) { |
| /* Noped */ |
| *q = value; |
| } else if (addr[-1] == *q) { |
| /* Moved */ |
| addr[-1] = value; |
| *q = value; |
| } else { |
| prom_printf(wrong_setaddr, addr-1, addr[-1], *addr, *q, value); |
| prom_halt(); |
| } |
| } |
| } |
| #else |
| static inline void set_addr(unsigned int *addr, unsigned int q1, int fmangled, unsigned int value) |
| { |
| *addr = value; |
| } |
| #endif |
| |
| void __init btfixup(void) |
| { |
| unsigned int *p, *q; |
| int type, count; |
| unsigned insn; |
| unsigned *addr; |
| int fmangled = 0; |
| void (*flush_cacheall)(void); |
| |
| if (!visited) { |
| visited++; |
| printk(version); |
| if (ARCH_SUN4C) |
| printk(str_sun4c); |
| else { |
| printk(str_srmmu, srmmu_name); |
| if (sparc_cpu_model == sun4d) |
| printk(str_iounit); |
| else |
| printk(str_iommu); |
| } |
| } |
| for (p = ___btfixup_start; p < ___btfixup_end; ) { |
| count = p[2]; |
| q = p + 3; |
| switch (type = *(unsigned char *)p) { |
| case 'f': |
| count = p[3]; |
| q = p + 4; |
| if (((p[0] & 1) || p[1]) |
| && ((p[1] & 3) || (unsigned *)(p[1]) < _stext || (unsigned *)(p[1]) >= _end)) { |
| prom_printf(wrong_f, p, p[1]); |
| prom_halt(); |
| } |
| break; |
| case 'b': |
| if (p[1] < (unsigned long)__init_begin || p[1] >= (unsigned long)__init_text_end || (p[1] & 3)) { |
| prom_printf(wrong_b, p, p[1]); |
| prom_halt(); |
| } |
| break; |
| case 's': |
| if (p[1] + 0x1000 >= 0x2000) { |
| prom_printf(wrong_s, p, p[1]); |
| prom_halt(); |
| } |
| break; |
| case 'h': |
| if (p[1] & 0x3ff) { |
| prom_printf(wrong_h, p, p[1]); |
| prom_halt(); |
| } |
| break; |
| case 'a': |
| if (p[1] + 0x1000 >= 0x2000 && (p[1] & 0x3ff)) { |
| prom_printf(wrong_a, p, p[1]); |
| prom_halt(); |
| } |
| break; |
| } |
| if (p[0] & 1) { |
| p[0] &= ~1; |
| while (count) { |
| fmangled = 0; |
| addr = (unsigned *)*q; |
| if (addr < _stext || addr >= _end) { |
| prom_printf(wrong, type, p); |
| prom_halt(); |
| } |
| insn = *addr; |
| #ifdef BTFIXUP_OPTIMIZE_OTHER |
| if (type != 'f' && q[1]) { |
| insn = *(unsigned int *)q[1]; |
| if (!insn || insn == 1) |
| insn = *addr; |
| else |
| fmangled = 1; |
| } |
| #endif |
| switch (type) { |
| case 'f': /* CALL */ |
| if (addr >= __start___ksymtab && addr < __stop___ksymtab) { |
| *addr = p[1]; |
| break; |
| } else if (!q[1]) { |
| if ((insn & 0xc1c00000) == 0x01000000) { /* SETHI */ |
| *addr = (insn & 0xffc00000) | (p[1] >> 10); break; |
| } else if ((insn & 0xc1f82000) == 0x80102000) { /* OR X, %LO(i), Y */ |
| *addr = (insn & 0xffffe000) | (p[1] & 0x3ff); break; |
| } else if ((insn & 0xc0000000) != 0x40000000) { /* !CALL */ |
| bad_f: |
| prom_printf(insn_f, p, addr, insn, addr[1]); |
| prom_halt(); |
| } |
| } else if (q[1] != 1) |
| addr[1] = q[1]; |
| if (p[2] == BTFIXUPCALL_NORM) { |
| norm_f: |
| *addr = 0x40000000 | ((p[1] - (unsigned)addr) >> 2); |
| q[1] = 0; |
| break; |
| } |
| #ifndef BTFIXUP_OPTIMIZE_NOP |
| goto norm_f; |
| #else |
| if (!(addr[1] & 0x80000000)) { |
| if ((addr[1] & 0xc1c00000) != 0x01000000) /* !SETHI */ |
| goto bad_f; /* CALL, Bicc, FBfcc, CBccc are weird in delay slot, aren't they? */ |
| } else { |
| if ((addr[1] & 0x01800000) == 0x01800000) { |
| if ((addr[1] & 0x01f80000) == 0x01e80000) { |
| /* RESTORE */ |
| goto norm_f; /* It is dangerous to patch that */ |
| } |
| goto bad_f; |
| } |
| if ((addr[1] & 0xffffe003) == 0x9e03e000) { |
| /* ADD %O7, XX, %o7 */ |
| int displac = (addr[1] << 19); |
| |
| displac = (displac >> 21) + 2; |
| *addr = (0x10800000) + (displac & 0x3fffff); |
| q[1] = addr[1]; |
| addr[1] = p[2]; |
| break; |
| } |
| if ((addr[1] & 0x201f) == 0x200f || (addr[1] & 0x7c000) == 0x3c000) |
| goto norm_f; /* Someone is playing bad tricks with us: rs1 or rs2 is o7 */ |
| if ((addr[1] & 0x3e000000) == 0x1e000000) |
| goto norm_f; /* rd is %o7. We'd better take care. */ |
| } |
| if (p[2] == BTFIXUPCALL_NOP) { |
| *addr = 0x01000000; |
| q[1] = 1; |
| break; |
| } |
| #ifndef BTFIXUP_OPTIMIZE_OTHER |
| goto norm_f; |
| #else |
| if (addr[1] == 0x01000000) { /* NOP in the delay slot */ |
| q[1] = addr[1]; |
| *addr = p[2]; |
| break; |
| } |
| if ((addr[1] & 0xc0000000) != 0xc0000000) { |
| /* Not a memory operation */ |
| if ((addr[1] & 0x30000000) == 0x10000000) { |
| /* Ok, non-memory op with rd %oX */ |
| if ((addr[1] & 0x3e000000) == 0x1c000000) |
| goto bad_f; /* Aiee. Someone is playing strange %sp tricks */ |
| if ((addr[1] & 0x3e000000) > 0x12000000 || |
| ((addr[1] & 0x3e000000) == 0x12000000 && |
| p[2] != BTFIXUPCALL_STO1O0 && p[2] != BTFIXUPCALL_SWAPO0O1) || |
| ((p[2] & 0xffffe000) == BTFIXUPCALL_RETINT(0))) { |
| /* Nobody uses the result. We can nop it out. */ |
| *addr = p[2]; |
| q[1] = addr[1]; |
| addr[1] = 0x01000000; |
| break; |
| } |
| if ((addr[1] & 0xf1ffffe0) == 0x90100000) { |
| /* MOV %reg, %Ox */ |
| if ((addr[1] & 0x3e000000) == 0x10000000 && |
| (p[2] & 0x7c000) == 0x20000) { |
| /* Ok, it is call xx; mov reg, %o0 and call optimizes |
| to doing something on %o0. Patch the patch. */ |
| *addr = (p[2] & ~0x7c000) | ((addr[1] & 0x1f) << 14); |
| q[1] = addr[1]; |
| addr[1] = 0x01000000; |
| break; |
| } |
| if ((addr[1] & 0x3e000000) == 0x12000000 && |
| p[2] == BTFIXUPCALL_STO1O0) { |
| *addr = (p[2] & ~0x3e000000) | ((addr[1] & 0x1f) << 25); |
| q[1] = addr[1]; |
| addr[1] = 0x01000000; |
| break; |
| } |
| } |
| } |
| } |
| *addr = addr[1]; |
| q[1] = addr[1]; |
| addr[1] = p[2]; |
| break; |
| #endif /* BTFIXUP_OPTIMIZE_OTHER */ |
| #endif /* BTFIXUP_OPTIMIZE_NOP */ |
| case 'b': /* BLACKBOX */ |
| /* Has to be sethi i, xx */ |
| if ((insn & 0xc1c00000) != 0x01000000) { |
| prom_printf(insn_b, p, addr, insn); |
| prom_halt(); |
| } else { |
| void (*do_fixup)(unsigned *); |
| |
| do_fixup = (void (*)(unsigned *))p[1]; |
| do_fixup(addr); |
| } |
| break; |
| case 's': /* SIMM13 */ |
| /* Has to be or %g0, i, xx */ |
| if ((insn & 0xc1ffe000) != 0x80102000) { |
| prom_printf(insn_s, p, addr, insn); |
| prom_halt(); |
| } |
| set_addr(addr, q[1], fmangled, (insn & 0xffffe000) | (p[1] & 0x1fff)); |
| break; |
| case 'h': /* SETHI */ |
| /* Has to be sethi i, xx */ |
| if ((insn & 0xc1c00000) != 0x01000000) { |
| prom_printf(insn_h, p, addr, insn); |
| prom_halt(); |
| } |
| set_addr(addr, q[1], fmangled, (insn & 0xffc00000) | (p[1] >> 10)); |
| break; |
| case 'a': /* HALF */ |
| /* Has to be sethi i, xx or or %g0, i, xx */ |
| if ((insn & 0xc1c00000) != 0x01000000 && |
| (insn & 0xc1ffe000) != 0x80102000) { |
| prom_printf(insn_a, p, addr, insn); |
| prom_halt(); |
| } |
| if (p[1] & 0x3ff) |
| set_addr(addr, q[1], fmangled, |
| (insn & 0x3e000000) | 0x80102000 | (p[1] & 0x1fff)); |
| else |
| set_addr(addr, q[1], fmangled, |
| (insn & 0x3e000000) | 0x01000000 | (p[1] >> 10)); |
| break; |
| case 'i': /* INT */ |
| if ((insn & 0xc1c00000) == 0x01000000) /* %HI */ |
| set_addr(addr, q[1], fmangled, (insn & 0xffc00000) | (p[1] >> 10)); |
| else if ((insn & 0x80002000) == 0x80002000 && |
| (insn & 0x01800000) != 0x01800000) /* %LO */ |
| set_addr(addr, q[1], fmangled, (insn & 0xffffe000) | (p[1] & 0x3ff)); |
| else { |
| prom_printf(insn_i, p, addr, insn); |
| prom_halt(); |
| } |
| break; |
| } |
| count -= 2; |
| q += 2; |
| } |
| } else |
| p = q + count; |
| } |
| #ifdef CONFIG_SMP |
| flush_cacheall = (void (*)(void))BTFIXUPVAL_CALL(local_flush_cache_all); |
| #else |
| flush_cacheall = (void (*)(void))BTFIXUPVAL_CALL(flush_cache_all); |
| #endif |
| if (!flush_cacheall) { |
| prom_printf(fca_und); |
| prom_halt(); |
| } |
| (*flush_cacheall)(); |
| } |
