X-Git-Url: https://notaz.gp2x.de/cgi-bin/gitweb.cgi?p=ginge.git;a=blobdiff_plain;f=loader%2Fpatches.c;h=a6e31921946a3d45e1b237613fe5baa2916365bb;hp=5418c1c80f5ae3ca80be6154de5caf238ac5e07b;hb=d0b9b0df7ed0dc36aabe30e2d584c27c8c32a3d9;hpb=3ef07128a8ad8a12688beee244c5e0a2629581de diff --git a/loader/patches.c b/loader/patches.c index 5418c1c..a6e3192 100644 --- a/loader/patches.c +++ b/loader/patches.c @@ -7,7 +7,7 @@ #include #include "header.h" -#include "sys_cacheflush.h" +#include "syscalls.h" #include "override.c" @@ -25,6 +25,12 @@ static const unsigned int sig_open[] = { }; #define sig_mask_open sig_mask_all +static const unsigned int sig_open_a1[] = { + 0xef900005, // svc 0x900005 + 0xe1a0f00e, // mov pc, lr +}; +#define sig_mask_open_a1 sig_mask_all + static const unsigned int sig_mmap[] = { 0xe92d000f, // push {r0, r1, r2, r3} 0xe1a0000d, // mov r0, sp @@ -48,7 +54,7 @@ static const unsigned int sig_mmap2[] = { 0xe1b0ca05, // lsls ip, r5, #20 0x1a000006, // bne 0x34 0xe1a05625, // lsr r5, r5, #12 - 0xef9000c0, // svc 0x009000c0 + 0xef9000c0, // svc 0x9000c0 }; #define sig_mask_mmap2 sig_mask_all @@ -61,6 +67,20 @@ static const unsigned int sig_read[] = { }; #define sig_mask_read sig_mask_all +static const unsigned int sig_read_a1[] = { + 0xef900003, // svc 0x900003 + 0xe3700a01, // cmn r0, #0x1000 + 0x312fff1e, // bxcc lr +}; +#define sig_mask_read_a1 sig_mask_all + +static const unsigned int sig_hw_read[] = { + 0xef900003, // svc 0x900003 + 0xe3700a01, // cmn r0, #0x1000 + 0xe1a04000, // mov r4, r0 +}; +#define sig_mask_hw_read sig_mask_all + static const unsigned int sig_ioctl[] = { 0xef900036, // svc 0x900036 0xe3700a01, // cmn r0, #0x1000 @@ -110,24 +130,44 @@ static const unsigned int sig_mask_chdir[] = { 0xffffffff, 0xffffffff, 0xffffffff, 0xff000000 }; -/* additional wrapper for harder case of syscalls within the code stream */ -extern int hw_ioctl(int fd, int request, void *argp); -asm( -"hw_ioctl:\n" -" stmfd sp!, {r1-r3,r12,lr}\n" -#ifdef PND // fix PC, not needed on ARM9 -" ldr r1, [sp, #5*4]\n" -" add r1, r1, #4\n" -" str r1, [sp, #5*4]\n" +/* special */ +static const unsigned int sig_cache1[] = { + 0xee073f5e, // mcr 15, 0, r3, cr7, cr14, 2 +}; +#define sig_mask_cache1 sig_mask_all + +static const unsigned int sig_cache2[] = { + 0xee070f17, // mcr 15, 0, r0, cr7, cr7, 0 +}; +#define sig_mask_cache2 sig_mask_all + +/* additional wrappers for harder case of syscalls within the code stream */ +#ifdef PND /* fix PC, not needed on ARM9 */ +# define SVC_CMN_R0_MOV_R4_PC_ADJ() \ +" ldr r12, [sp, #5*4]\n" \ +" add r12, r12, #4\n" \ +" str r12, [sp, #5*4]\n" +#else +# define SVC_CMN_R0_MOV_R4_PC_ADJ() #endif -" bl w_ioctl\n" -" cmn r0, #0x1000\n" -" mov r4, r0\n" -" ldmfd sp!, {r1-r3,r12,lr,pc}\n" + +#define SVC_CMN_R0_MOV_R4_WRAPPER(name, target) \ +extern int name(); \ +asm( \ +#name ":\n" \ +" stmfd sp!, {r1-r3,r12,lr}\n" \ + SVC_CMN_R0_MOV_R4_PC_ADJ() \ +" bl " #target "\n" \ +" cmn r0, #0x1000\n" \ +" mov r4, r0\n" \ +" ldmfd sp!, {r1-r3,r12,lr,pc}\n" \ ); -#define PATCH_(f, p, t) { sig_##p, sig_mask_##p, ARRAY_SIZE(sig_##p), t, f } -#define PATCH(f) PATCH_(w_##f, f, 0) +SVC_CMN_R0_MOV_R4_WRAPPER(hw_read, w_read) +SVC_CMN_R0_MOV_R4_WRAPPER(hw_ioctl, w_ioctl) + +#define PATCH_(p, f, t) { sig_##p, sig_mask_##p, ARRAY_SIZE(sig_##p), t, f, #p } +#define PATCH(f) PATCH_(f, w_##f, 0) static const struct { const unsigned int *sig; @@ -135,56 +175,69 @@ static const struct { size_t sig_cnt; unsigned int type; void *func; + const char *name; } patches[] = { - PATCH(open), - PATCH(mmap), - PATCH(mmap2), // mmap2 syscall - PATCH(munmap), - PATCH(read), - PATCH(ioctl), + PATCH (open), + PATCH_(open_a1, w_open, 0), + PATCH (mmap), + PATCH (mmap2), // mmap2 syscall + PATCH (munmap), + PATCH (read), + PATCH_(read_a1, w_read, 0), + PATCH_(hw_read, hw_read, 1), + PATCH (ioctl), PATCH_(hw_ioctl, hw_ioctl, 1), - PATCH(sigaction), -// PATCH_(execve, execve2), // hangs - PATCH(chdir), + PATCH (sigaction), +// PATCH_(execve, execve2, 0), // hangs + PATCH (chdir), + PATCH_(cache1, NULL, 2), + PATCH_(cache2, NULL, 2), }; void do_patches(void *ptr, unsigned int size) { + unsigned int *seg = (void *)(((long)ptr + 3) & ~3); + unsigned int *seg_end = seg + size / 4; int i, s; - for (i = 0; i < ARRAY_SIZE(patches); i++) { - const unsigned int *sig = patches[i].sig; - const unsigned int *sig_mask = patches[i].sig_mask; - unsigned int *seg = (void *)(((long)ptr + 3) & ~3); - unsigned int *seg_end = seg + size / 4; - unsigned int sig0 = sig[0]; + for (; seg < seg_end; seg++) { + for (i = 0; i < ARRAY_SIZE(patches); i++) { + const unsigned int *sig = patches[i].sig; + const unsigned int *sig_mask; - for (; seg < seg_end; seg++) { - if (*seg != sig0) + if (*seg != sig[0]) continue; + sig_mask = patches[i].sig_mask; for (s = 1; s < patches[i].sig_cnt; s++) if ((seg[s] ^ sig[s]) & sig_mask[s]) break; if (s == patches[i].sig_cnt) { - dbg(" patch #%i @ %08x type %d\n", i, (int)seg, patches[i].type); switch (patches[i].type) { case 0: - seg[0] = 0xe59ff000; // ldr pc, [pc] - seg[1] = 0; - seg[2] = (unsigned int)patches[i].func; + seg[0] = 0xe51ff004; // ldr pc, [pc, #-4] + seg[1] = (unsigned int)patches[i].func; break; case 1: seg[0] = 0xe92d8000; // stmfd sp!, {pc} - seg[1] = 0xe51ff004; // pc, [pc, #-4] + seg[1] = 0xe51ff004; // ldr pc, [pc, #-4] seg[2] = (unsigned int)patches[i].func; break; + case 2: + if (seg < (unsigned int *)ptr + 1 || (seg[-1] >> 28) != 0x0e) + // might be data + continue; + seg[0] = 0xe1a00000; // nop + break; default: err("bad patch type: %u\n", patches[i].type); abort(); } + dbg(" patch #%2i @ %08x type %d %s\n", + i, (int)seg, patches[i].type, patches[i].name); seg += patches[i].sig_cnt - 1; + break; } } }