refactor: reduce global var in trap.c to one pointer
[mate.git] / ffi / trap.c
index a2af9708299ce884c30d1fb70d8220842c9c6453..0302c5ea0667659c4ce21bd6728c31b49f574a8a 100644 (file)
@@ -1,6 +1,11 @@
 #include <stdio.h>
 #include <stdlib.h>
 
+#include "../debug.h"
+
+/* TODO(bernhard): use {u,}int* types */
+
+#define __USE_GNU
 // Note by hs: my signal.h includes sys/uconctext which conflicts with
 // asm/ucontext - this hack kinda solves the problem for me ;-) 
 // so feel free to blame me for that s**t
 #define __USE_XOPEN2K8
 #endif
 
-#include <asm/ucontext.h>
-
-unsigned int getMethodEntry(unsigned int, void *, void *);
-unsigned int getStaticFieldAddr(unsigned int, void*);
-
-#define NEW_MAP(prefix) \
-       void* prefix ## _map = NULL; \
-       void set_ ## prefix ## map(void *map) \
-       { \
-               printf("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); \
-               return prefix ## _map; \
-       }
+#include <sys/ucontext.h>
+
+unsigned int getMethodEntry(unsigned int, unsigned int);
+unsigned int getStaticFieldAddr(unsigned int);
+unsigned int getTrapType(unsigned int, unsigned int);
+unsigned int mallocObject(int);
 
-NEW_MAP(method)
-NEW_MAP(trap)
-NEW_MAP(class)
+#ifdef DBG_TRAP
+#define dprintf(args...) do { printf (args); } while (0);
+#else
+#define dprintf(args...)
+#endif
+
+void *mate_ctx = NULL;
 
+void *get_mate_context()
+{
+       return mate_ctx;
+}
+
+void *set_mate_context(void *ctx)
+{
+       mate_ctx = ctx;
+}
 
 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)
 {
-       struct ucontext *uctx = (struct ucontext *) ctx;
-       unsigned int from = (unsigned int) uctx->uc_mcontext.eip - 2;
+       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, method_map, trap_map);
+       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);
-       uctx->uc_mcontext.eip = (unsigned long) insn;
-       // while (1) ;
+       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)
 {
-       struct ucontext *uctx = (struct ucontext *) ctx;
-       unsigned int from = (unsigned int) uctx->uc_mcontext.eip;
-       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);
+       mcontext_t *mctx = &((ucontext_t *) ctx)->uc_mcontext;
+       unsigned int from = (unsigned int) mctx->gregs[REG_EIP];
+       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);
 
-       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);
+                       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);
 }
 
@@ -102,7 +151,7 @@ unsigned int getaddr(void)
        return (unsigned int) mainresult;
 }
 
-unsigned int getMallocAddr(void)
+unsigned int getMallocObjectAddr(void)
 {
-       return (unsigned int) malloc;
+       return (unsigned int) mallocObject;
 }