refactor: trap.c
[mate.git] / ffi / trap.c
index 228b2c36f3e96d1122f9b7ec74ed631ca2d8b5c3..3b5e78309dbf301656fa33001bd962fb6be2f144 100644 (file)
 
 unsigned int getMethodEntry(unsigned int, unsigned int);
 unsigned int getStaticFieldAddr(unsigned int, void*);
+unsigned int getTrapType(unsigned int, unsigned int);
+
+#ifdef DEBUG
+#define dprintf(args...) do { printf (args); } while (0);
+#else
+#define dprintf(args...)
+#endif
 
 #define NEW_MAP(prefix) \
        void* prefix ## _map = NULL; \
        void set_ ## prefix ## map(void *map) \
        { \
-               printf("set_%s: 0x%08x\n", #prefix , (unsigned int) map); \
+               dprintf("set_%s: 0x%08x\n", #prefix , (unsigned int) map); \
                prefix ## _map = map; \
        } \
        void *get_ ## prefix ## map() \
        { \
-               printf("get_%s: 0x%08x\n", #prefix , (unsigned int) prefix ## _map); \
+               dprintf("get_%s: 0x%08x\n", #prefix , (unsigned int) prefix ## _map); \
                return prefix ## _map; \
        }
 
@@ -39,84 +46,110 @@ NEW_MAP(method)
 NEW_MAP(trap)
 NEW_MAP(class)
 NEW_MAP(virtual)
+NEW_MAP(strings)
+NEW_MAP(interfaces)
+NEW_MAP(interfacemethod)
 
 
 void mainresult(unsigned int a)
 {
-       printf("mainresult: 0x%08x\n", a);
+       dprintf("mainresult: 0x%08x\n", a);
 }
 
-void callertrap(int nSignal, siginfo_t *info, void *ctx)
+void staticcalltrap(int nSignal, siginfo_t *info, void *ctx)
 {
        mcontext_t *mctx = &((ucontext_t *) ctx)->uc_mcontext;
        unsigned int from = (unsigned int) mctx->gregs[REG_EIP] - 2;
        unsigned int *to_patch = (unsigned int *) (from + 1);
-       printf("callertrap(mctx)  by 0x%08x\n", from);
+       dprintf("callertrap(mctx)  by 0x%08x\n", from);
        if (*to_patch != 0x90ffff90) {
-               printf("callertrap: something is wrong here. abort\n");
+               dprintf("callertrap: something is wrong here. abort\n");
                exit(0);
        }
        unsigned int patchme = getMethodEntry(from, 0);
 
        unsigned char *insn = (unsigned char *) from;
        *insn = 0xe8; // call opcode
-       printf(" to_patch: 0x%08x\n", (unsigned int) to_patch);
-       printf("*to_patch: 0x%08x\n", *to_patch);
+       dprintf(" to_patch: 0x%08x\n", (unsigned int) to_patch);
+       dprintf("*to_patch: 0x%08x\n", *to_patch);
        *to_patch = patchme - (from + 5);
-       printf("*to_patch: 0x%08x\n", *to_patch);
+       dprintf("*to_patch: 0x%08x\n", *to_patch);
        mctx->gregs[REG_EIP] = (unsigned long) insn;
 }
 
-void staticfieldtrap(int nSignal, siginfo_t *info, void *ctx)
+void sigsegvtrap(int nSignal, siginfo_t *info, void *ctx)
 {
-       /* TODO(bernhard): more generic and cleaner please... */
        mcontext_t *mctx = &((ucontext_t *) ctx)->uc_mcontext;
        unsigned int from = (unsigned int) mctx->gregs[REG_EIP];
-       if (from < 0x10000) { // invokevirtual
-               if (from > 0) {
-                       printf("from: 0x%08x but should be 0 :-(\n", from);
-               }
-               unsigned int method_table_ptr = (unsigned int) mctx->gregs[REG_EAX];
-               unsigned int *esp = (unsigned int *) mctx->gregs[REG_ESP];
-               /* get actual eip from stack storage */
-               unsigned int from = (*esp) - 3;
-               unsigned char offset = *((unsigned char *) (*esp) - 1);
-               /* method entry to patch */
-               unsigned int *to_patch = (unsigned int*) (method_table_ptr + offset);
-               printf("invokevirtual by 0x%08x with offset 0x%08x\n", from, offset);
-               printf(" to_patch: 0x%08x\n", (unsigned int) to_patch);
-               printf("*to_patch: 0x%08x\n", *to_patch);
-               *to_patch = getMethodEntry(from, method_table_ptr);
-               mctx->gregs[REG_EIP] = *to_patch;
-               printf("*to_patch: 0x%08x\n", *to_patch);
-       } else {
-       unsigned int *to_patch = (unsigned int *) (from + 2);
-       printf("staticfieldtrap by 0x%08x\n", from);
-       if (*to_patch != 0x00000000) {
-               printf("staticfieldtrap: something is wrong here. abort\n");
-               exit(0);
-       }
-       unsigned int patchme = getStaticFieldAddr(from, trap_map);
-
-       printf(" to_patch: 0x%08x\n", (unsigned int) to_patch);
-       printf("*to_patch: 0x%08x\n", *to_patch);
-       *to_patch = patchme;
-       printf("*to_patch: 0x%08x\n", *to_patch);
+       unsigned int *esp = (unsigned int *) mctx->gregs[REG_ESP];
+
+       /* if from is not *the* eip: get actual eip from stack storage */
+       unsigned int from_stack = (*esp) - 3;
+       switch(getTrapType(from, from_stack)) {
+               default: case 0: {
+                       dprintf("something is wrong here: abort\n");
+                       exit(1);
+               } break;
+               case 1: { // invokevirtual
+                       if (from > 0) {
+                               dprintf("from: 0x%08x but should be 0 :-(\n", from);
+                       }
+                       unsigned int method_table_ptr = (unsigned int) mctx->gregs[REG_EAX];
+                       unsigned char offset = *((unsigned char *) (*esp) - 1);
+                       /* method entry to patch */
+                       unsigned int *to_patch = (unsigned int*) (method_table_ptr + offset);
+                       dprintf("invokevirtual by 0x%08x with offset 0x%08x\n", from_stack, offset);
+                       dprintf(" to_patch: 0x%08x\n", (unsigned int) to_patch);
+                       dprintf("*to_patch: 0x%08x\n", *to_patch);
+                       *to_patch = getMethodEntry(from_stack, method_table_ptr);
+                       mctx->gregs[REG_EIP] = *to_patch;
+                       dprintf("*to_patch: 0x%08x\n", *to_patch);
+               } break;
+               case 4: { // invokeinterface
+                       if (from > 0) {
+                               dprintf("from: 0x%08x but should be 0 :-(\n", from);
+                       }
+                       unsigned int method_table_ptr = (unsigned int) mctx->gregs[REG_EAX];
+                       unsigned int interface_table_ptr = (unsigned int) mctx->gregs[REG_EBX];
+                       unsigned char offset = *((unsigned char *) (*esp) - 1);
+                       /* interface entry to patch */
+                       unsigned int *to_patch = (unsigned int*) (interface_table_ptr + offset);
+                       dprintf("invokeinterface by 0x%08x with offset 0x%08x\n", from_stack, offset);
+                       dprintf(" to_patch: 0x%08x\n", (unsigned int) to_patch);
+                       dprintf("*to_patch: 0x%08x\n", *to_patch);
+                       *to_patch = getMethodEntry(from_stack, method_table_ptr);
+                       mctx->gregs[REG_EIP] = *to_patch;
+                       dprintf("*to_patch: 0x%08x\n", *to_patch);
+               } break;
+               case 2: { // static field patch
+                       unsigned int *to_patch = (unsigned int *) (from + 2);
+                       dprintf("staticfieldtrap by 0x%08x\n", from);
+                       if (*to_patch != 0x00000000) {
+                               dprintf("staticfieldtrap: something is wrong here. abort\n");
+                               exit(0);
+                       }
+                       unsigned int patchme = getStaticFieldAddr(from, trap_map);
+
+                       dprintf(" to_patch: 0x%08x\n", (unsigned int) to_patch);
+                       dprintf("*to_patch: 0x%08x\n", *to_patch);
+                       *to_patch = patchme;
+                       dprintf("*to_patch: 0x%08x\n", *to_patch);
+               } break;
        }
 }
 
 void register_signal(void)
 {
        struct sigaction illaction;
-       illaction.sa_sigaction = callertrap;
+       illaction.sa_sigaction = staticcalltrap;
        sigemptyset(&illaction.sa_mask);
-       illaction.sa_flags = SA_SIGINFO | SA_RESTART;
+       illaction.sa_flags = SA_SIGINFO | SA_RESTART | SA_NODEFER;
        sigaction(SIGILL, &illaction, NULL);
 
        struct sigaction segvaction;
-       segvaction.sa_sigaction = staticfieldtrap;
+       segvaction.sa_sigaction = sigsegvtrap;
        sigemptyset(&segvaction.sa_mask);
-       segvaction.sa_flags = SA_SIGINFO | SA_RESTART;
+       segvaction.sa_flags = SA_SIGINFO | SA_RESTART | SA_NODEFER;
        sigaction(SIGSEGV, &segvaction, NULL);
 }