From: notaz Date: Thu, 14 Jan 2016 22:38:21 +0000 (+0200) Subject: create an additional linkpage reachable from SOs X-Git-Url: https://notaz.gp2x.de/cgi-bin/gitweb.cgi?p=ginge.git;a=commitdiff_plain;h=890c1dc54f2d12febbf4238c73ccd145a6724771 create an additional linkpage reachable from SOs --- diff --git a/loader/dl.c b/loader/dl.c index 4282764..6b0df2f 100644 --- a/loader/dl.c +++ b/loader/dl.c @@ -25,7 +25,7 @@ static void next_line(FILE *f) __attribute__((constructor)) static void ginge_init(void) { - unsigned int lowest_segment = (unsigned int)-1; + void *lowest_segments[2] = { NULL, NULL }; unsigned int start, end; int i, ret; FILE *f; @@ -50,13 +50,7 @@ static void ginge_init(void) perror("parse maps"); exit(1); } - lowest_segment = start; - - // assume first entry lists program's text section. - // unprotect it in case we need some patching. - ret = mprotect((void *)start, end - start, PROT_READ|PROT_WRITE|PROT_EXEC); - if (ret != 0) - perror("warning: mprotect"); + lowest_segments[0] = (void *)start; while (1) { next_line(f); @@ -65,8 +59,15 @@ static void ginge_init(void) if (ret <= 0) break; - if (start < lowest_segment) - lowest_segment = start; + if (lowest_segments[0] == NULL || (void *)start < lowest_segments[0]) + lowest_segments[0] = (void *)start; + else if (lowest_segments[1] == NULL + && (char *)start - (char *)lowest_segments[0] > 0x800000) + { + // an offset is needed because ld-linux also + // tends to put stuff here + lowest_segments[1] = (void *)(start - 0x20000); + } } #if 0 @@ -82,7 +83,7 @@ static void ginge_init(void) unsetenv("LD_PRELOAD"); unsetenv("LD_LIBRARY_PATH"); - emu_init((void *)lowest_segment); + emu_init(lowest_segments, 1); } // vim:shiftwidth=2:expandtab diff --git a/loader/emu.c b/loader/emu.c index 8234a14..3a2bd65 100644 --- a/loader/emu.c +++ b/loader/emu.c @@ -78,6 +78,8 @@ typedef unsigned char u8; static int fb_sync_thread_paused; static int fb_sync_thread_futex; +static int emu_is_dl; + static struct { u32 dstctrl; u32 dstaddr; @@ -727,6 +729,7 @@ struct op_context { }; struct op_linkpage { + u32 *code_ptr; void (*handler)(struct op_context *op_ctx); u32 code[0]; }; @@ -736,8 +739,7 @@ struct op_stackframe { u32 cpsr; }; -static struct op_linkpage *g_linkpage; -static u32 *g_code_ptr; +static struct op_linkpage *g_linkpages[2]; static int g_linkpage_count; enum opcond { @@ -889,7 +891,7 @@ static u32 make_jmp(u32 *pc, u32 *target, int bl) int jmp_val; jmp_val = target - pc - 2; - if (jmp_val < (int)0xff000000 || jmp_val > 0x00ffffff) { + if (jmp_val < (int)0xff800000 || jmp_val > 0x007fffff) { err("jump out of range (%p -> %p)\n", pc, target); abort(); } @@ -897,21 +899,22 @@ static u32 make_jmp(u32 *pc, u32 *target, int bl) return 0xea000000 | (bl << 24) | (jmp_val & 0x00ffffff); } -static void emit_op(u32 op) +static void emit_op(struct op_linkpage *linkpage, u32 op) { - *g_code_ptr++ = op; + *linkpage->code_ptr++ = op; } -static void emit_op_io(u32 op, u32 *target) +static void emit_op_io(struct op_linkpage *linkpage, + u32 op, u32 *target) { - op |= make_offset12(g_code_ptr, target); - emit_op(op); + op |= make_offset12(linkpage->code_ptr, target); + emit_op(linkpage, op); } -static void init_linkpage(void) +static void init_linkpage(struct op_linkpage *linkpage) { - g_linkpage->handler = emu_call_handle_op; - g_code_ptr = g_linkpage->code; + linkpage->handler = emu_call_handle_op; + linkpage->code_ptr = linkpage->code; } static void segv_sigaction(int num, siginfo_t *info, void *ctx) @@ -921,15 +924,16 @@ static void segv_sigaction(int num, siginfo_t *info, void *ctx) u32 *regs = (u32 *)&context->uc_mcontext.arm_r0; u32 *pc = (u32 *)regs[15]; u32 self_start, self_end; + struct op_linkpage *lp = NULL; struct op_context *op_ctx; - int i, lp_size; + int i, ret, lp_i, lp_size; self_start = (u32)&_init & ~0xfff; self_end = (u32)&_end; - if ((self_start <= regs[15] && regs[15] <= self_end) || // PC is in our segment or - (((regs[15] ^ (u32)g_linkpage) & ~(LINKPAGE_ALLOC - 1)) == 0) || // .. in linkpage - ((long)info->si_addr & 0xffe00000) != 0x7f000000) // faulting not where expected + if ((self_start <= regs[15] && regs[15] <= self_end) || // PC is in our segment or + !((regs[15] ^ (u32)g_linkpages[0]) & ~(LINKPAGE_ALLOC - 1)) || // .. in linkpage + ((long)info->si_addr & 0xffe00000) != 0x7f000000) // faulting not where expected { // real crash - time to die err("segv %d %p @ %08x\n", info->si_code, info->si_addr, regs[15]); @@ -941,52 +945,74 @@ static void segv_sigaction(int num, siginfo_t *info, void *ctx) } segvlog("segv %d %p @ %08x\n", info->si_code, info->si_addr, regs[15]); + // find nearby linkpage + for (lp_i = 0; lp_i < ARRAY_SIZE(g_linkpages); lp_i++) { + if (g_linkpages[lp_i] == NULL) + continue; + i = g_linkpages[lp_i]->code_ptr + 2 - pc - 2; + if ((int)0xff800000 <= i && i <= 0x007fffff) { + lp = g_linkpages[lp_i]; + break; + } + } + + if (lp == NULL) { + err("fatal: no nearby linkpage for %08x\n", regs[15]); + abort(); + } + + if (emu_is_dl) { + ret = mprotect((void *)((long)pc & ~0xfff), 0x1000, PROT_READ|PROT_WRITE|PROT_EXEC); + if (ret != 0) + perror("warning: mprotect"); + } + // spit PC and op - op_ctx = (void *)g_code_ptr; + op_ctx = (void *)lp->code_ptr; op_ctx->pc = (u32)pc; op_ctx->op = *pc; - g_code_ptr = &op_ctx->code[0]; + lp->code_ptr = &op_ctx->code[0]; // emit jump to code ptr - *pc = make_jmp(pc, g_code_ptr, 0); + *pc = make_jmp(pc, lp->code_ptr, 0); // generate code: - emit_op (0xe50d0000 + 0xf00 - 4 * 0); // str r0, [sp, #(-0xf00 + r0_offs)] - emit_op (0xe50de000 + 0xf00 - 4 * 14); // str lr, [sp, #(-0xf00 + lr_offs)] - emit_op (0xe24f0000 + (g_code_ptr - (u32 *)op_ctx + 2) * 4); // sub r0, pc, #op_ctx - emit_op (0xe1a0e00f); // mov lr, pc - emit_op_io(0xe51ff000, (u32 *)&g_linkpage->handler); // ldr pc, =handle_op - emit_op (0xe51de000 + 0xf00 - 4 * 14); // ldr lr, [sp, #(-0xf00 + lr_offs)] - emit_op (make_jmp(g_code_ptr, pc + 1, 0)); // jmp + emit_op (lp, 0xe50d0000 + 0xf00 - 4 * 0); // str r0, [sp, #(-0xf00 + r0_offs)] + emit_op (lp, 0xe50de000 + 0xf00 - 4 * 14); // str lr, [sp, #(-0xf00 + lr_offs)] + emit_op (lp, 0xe24f0000 + (lp->code_ptr - (u32 *)op_ctx + 2) * 4); // sub r0, pc, #op_ctx + emit_op (lp, 0xe1a0e00f); // mov lr, pc + emit_op_io(lp, 0xe51ff000, (u32 *)&lp->handler); // ldr pc, =handle_op + emit_op (lp, 0xe51de000 + 0xf00 - 4 * 14); // ldr lr, [sp, #(-0xf00 + lr_offs)] + emit_op (lp, make_jmp(lp->code_ptr, pc + 1, 0)); // jmp // sync caches sys_cacheflush(pc, pc + 1); - sys_cacheflush(g_linkpage, g_code_ptr); + sys_cacheflush(lp, lp->code_ptr); - lp_size = (char *)g_code_ptr - (char *)g_linkpage; + lp_size = (char *)lp->code_ptr - (char *)lp; segvlog("code #%d %d/%d\n", g_linkpage_count, lp_size, LINKPAGE_SIZE); - if (lp_size + 13*4 > LINKPAGE_SIZE) { + if (lp_size + 14*4 > LINKPAGE_SIZE) { g_linkpage_count++; if (g_linkpage_count >= LINKPAGE_COUNT) { err("too many linkpages needed\n"); abort(); } - g_linkpage = (void *)((char *)g_linkpage + LINKPAGE_SIZE); - init_linkpage(); + g_linkpages[lp_i] = (void *)((char *)g_linkpages[lp_i] + LINKPAGE_SIZE); + init_linkpage(g_linkpages[lp_i]); } //handle_op(regs[15], op, regs, (u32)info->si_addr); //regs[15] += 4; } -void emu_init(void *map_bottom) +void emu_init(void *map_bottom[2], int is_dl) { sigaction_t segv_action = { .sa_sigaction = segv_sigaction, .sa_flags = SA_SIGINFO, }; void *pret; - int ret; + int i, ret; #ifdef PND if (geteuid() == 0) { @@ -996,15 +1022,22 @@ void emu_init(void *map_bottom) } #endif - g_linkpage = (void *)(((u32)map_bottom - LINKPAGE_ALLOC) & ~0xfff); - pret = mmap(g_linkpage, LINKPAGE_ALLOC, PROT_READ|PROT_WRITE, - MAP_PRIVATE|MAP_ANONYMOUS|MAP_FIXED, -1, 0); - if (pret != g_linkpage) { - perror(PFX "mmap linkpage"); - exit(1); + emu_is_dl = is_dl; + + for (i = 0; i < 2; i++) { + if (map_bottom[i] == NULL) + continue; + g_linkpages[i] = (void *)(((u32)map_bottom[i] - LINKPAGE_ALLOC) & ~0xfff); + pret = mmap(g_linkpages[i], LINKPAGE_ALLOC, PROT_READ|PROT_WRITE, + MAP_PRIVATE|MAP_ANONYMOUS|MAP_FIXED, -1, 0); + if (pret != g_linkpages[i]) { + err("linkpage alloc @ %p: ", g_linkpages[i]); + perror(NULL); + exit(1); + } + log("linkpages @ %p\n", g_linkpages[i]); + init_linkpage(g_linkpages[i]); } - log("linkpages @ %p\n", g_linkpage); - init_linkpage(); // host stuff ret = host_init(); diff --git a/loader/header.h b/loader/header.h index da03c00..edde685 100644 --- a/loader/header.h +++ b/loader/header.h @@ -44,7 +44,7 @@ void do_patches(void *ptr, unsigned int size); struct op_context; -void emu_init(void *map_bottom); +void emu_init(void *map_bottom[2], int is_dl); void emu_call_handle_op(struct op_context *op_ctx); long emu_do_mmap(unsigned int length, int prot, int flags, int fd, unsigned int offset); long emu_do_munmap(void *addr, unsigned int length); diff --git a/loader/loader.c b/loader/loader.c index 27ea856..8a021df 100644 --- a/loader/loader.c +++ b/loader/loader.c @@ -66,7 +66,7 @@ extern char **environ; int main(int argc, char *argv[]) { - void *lowest_segment = (void *)-1; + void *lowest_segments[2] = { NULL, NULL }; Elf32_Ehdr hdr; Elf32_Phdr *phdr; FILE *fi; @@ -160,8 +160,8 @@ int main(int argc, char *argv[]) do_patches((char *)ptr + align, phdr[i].p_filesz); } - if (map_ptr < lowest_segment) - lowest_segment = map_ptr; + if (lowest_segments[0] == NULL || map_ptr < lowest_segments[0]) + lowest_segments[0] = map_ptr; } // build self bin path @@ -177,7 +177,7 @@ int main(int argc, char *argv[]) fclose(fi); - emu_init(lowest_segment); + emu_init(lowest_segments, 0); // generate stack frame: argc, argv[], NULL, env[], NULL for (envc = 0; environ[envc] != NULL; envc++)