pavolmarko@733: #include pavolmarko@733: #include "sourcehook_test.h" pavolmarko@733: #include "sh_pagealloc.h" pavolmarko@733: #include "testevents.h" pavolmarko@733: pavolmarko@733: namespace pavolmarko@733: { pavolmarko@733: StateList g_States; pavolmarko@733: SourceHook::ISourceHook *g_SHPtr; pavolmarko@733: SourceHook::Plugin g_PLID; pavolmarko@733: pavolmarko@733: MAKE_STATE(State_Func_Called); pavolmarko@733: MAKE_STATE(State_Pre1_Called); pavolmarko@733: MAKE_STATE(State_Pre2_Called); pavolmarko@733: pavolmarko@733: int g_CallNumber; pavolmarko@733: pavolmarko@733: class Test pavolmarko@733: { pavolmarko@733: public: pavolmarko@733: virtual void Func() pavolmarko@733: { pavolmarko@733: ADD_STATE(State_Func_Called); pavolmarko@733: } pavolmarko@733: }; pavolmarko@733: pavolmarko@733: Test *g_pInst; pavolmarko@733: pavolmarko@733: void Handler_Func_Pre1() pavolmarko@733: { pavolmarko@733: ADD_STATE(State_Pre1_Called); pavolmarko@733: } pavolmarko@733: pavolmarko@733: SH_DECL_HOOK0_void(Test, Func, SH_NOATTRIB, 0); pavolmarko@733: pavolmarko@733: void Handler_Func_Pre2() pavolmarko@733: { pavolmarko@733: ADD_STATE(State_Pre2_Called); pavolmarko@733: pavolmarko@733: ++g_CallNumber; pavolmarko@733: if (g_CallNumber == 2) pavolmarko@733: { pavolmarko@733: // REMOVE ourselves pavolmarko@733: SH_REMOVE_HOOK(Test, Func, g_pInst, SH_STATIC(Handler_Func_Pre1), false); pavolmarko@733: SH_REMOVE_HOOK(Test, Func, g_pInst, SH_STATIC(Handler_Func_Pre2), false); pavolmarko@733: } pavolmarko@733: pavolmarko@733: // Call again. pavolmarko@733: g_pInst->Func(); pavolmarko@733: } pavolmarko@733: pavolmarko@733: Test *MyInstanceFactory() pavolmarko@733: { pavolmarko@733: return new Test; pavolmarko@733: } pavolmarko@733: pavolmarko@733: SourceHook::CPageAlloc g_ThunkAllocator(2); pavolmarko@733: void *g_OddThunkMemory = NULL; pavolmarko@733: void *g_OddThunk = NULL; pavolmarko@733: pavolmarko@733: // Guarantees that Func() pavolmarko@733: // has a vtable entry showing to an ODD address pavolmarko@733: void PatchFuncWithOddThunk() pavolmarko@733: { pavolmarko@733: g_OddThunkMemory = g_ThunkAllocator.Alloc(10); pavolmarko@733: unsigned char* base = reinterpret_cast(g_OddThunkMemory); pavolmarko@733: pavolmarko@733: if (((ptrdiff_t)base) & 1) pavolmarko@733: { pavolmarko@733: // ODD, ok. pavolmarko@733: } pavolmarko@733: else pavolmarko@733: { pavolmarko@733: // EVEN. make odd. pavolmarko@733: base += 1; pavolmarko@733: } pavolmarko@733: pavolmarko@733: // Get vtable entry pointer pavolmarko@733: SourceHook::MemFuncInfo info = {true, -1, 0, 0}; pavolmarko@733: SourceHook::GetFuncInfo(g_pInst, &Test::Func, info); pavolmarko@733: pavolmarko@733: void *adjustediface = NULL; pavolmarko@733: void **cur_vtptr = NULL; pavolmarko@733: void **cur_vfnptr = NULL; pavolmarko@733: pavolmarko@733: adjustediface = reinterpret_cast(reinterpret_cast(g_pInst) + info.thisptroffs); pavolmarko@733: pavolmarko@733: cur_vtptr = *reinterpret_cast( pavolmarko@733: reinterpret_cast(adjustediface) + info.vtbloffs); pavolmarko@733: cur_vfnptr = reinterpret_cast(cur_vtptr + info.vtblindex); pavolmarko@733: pavolmarko@733: pavolmarko@733: // Original function pavolmarko@733: void *origEntry = *cur_vfnptr; pavolmarko@733: pavolmarko@733: // Now generate the jump code pavolmarko@733: g_ThunkAllocator.SetRW(g_OddThunkMemory); pavolmarko@733: pavolmarko@733: *(base + 0) = 0xE9; // offset jump, immediate operand pavolmarko@733: ptrdiff_t *offsetAddr = reinterpret_cast(base + 1); pavolmarko@733: pavolmarko@733: // destination = src + offset + 5 pavolmarko@733: // <=> offset = destination - src - 5 pavolmarko@733: *offsetAddr = pavolmarko@733: (reinterpret_cast(origEntry) - base) - 5; pavolmarko@733: pavolmarko@733: g_ThunkAllocator.SetRE(g_OddThunkMemory); pavolmarko@733: pavolmarko@733: g_OddThunk = reinterpret_cast(base); pavolmarko@733: pavolmarko@733: // Now set the odd thunk as new vtable entry pavolmarko@733: SourceHook::SetMemAccess((void*)cur_vfnptr, sizeof(void*), SH_MEM_READ | SH_MEM_WRITE); pavolmarko@733: *cur_vfnptr = g_OddThunk; pavolmarko@733: } pavolmarko@733: pavolmarko@733: void FreeOddThunk() pavolmarko@733: { pavolmarko@733: g_ThunkAllocator.Free(g_OddThunkMemory); pavolmarko@733: g_OddThunk = NULL; pavolmarko@733: } pavolmarko@733: } pavolmarko@733: pavolmarko@733: bool TestOddThunks(std::string &error) pavolmarko@733: { pavolmarko@733: GET_SHPTR(g_SHPtr); pavolmarko@733: g_PLID = 1337; pavolmarko@733: pavolmarko@733: g_CallNumber = 0; pavolmarko@733: pavolmarko@733: g_pInst = MyInstanceFactory(); pavolmarko@733: pavolmarko@733: PatchFuncWithOddThunk(); pavolmarko@733: pavolmarko@733: SH_ADD_HOOK(Test, Func, g_pInst, SH_STATIC(Handler_Func_Pre1), false); pavolmarko@733: SH_ADD_HOOK(Test, Func, g_pInst, SH_STATIC(Handler_Func_Pre2), false); pavolmarko@733: pavolmarko@733: g_pInst->Func(); pavolmarko@733: pavolmarko@733: CHECK_STATES((&g_States, pavolmarko@733: // FIRST func() call pavolmarko@733: new State_Pre1_Called(), pavolmarko@733: new State_Pre2_Called(), // calls Func() again pavolmarko@733: pavolmarko@733: // SECOND func() call pavolmarko@733: new State_Pre1_Called(), pavolmarko@733: new State_Pre2_Called(), // removes hooks and calls Func() again pavolmarko@733: pavolmarko@733: // THIRD func() call pavolmarko@733: new State_Func_Called(), pavolmarko@733: pavolmarko@733: // SECOND func() call pavolmarko@733: new State_Func_Called(), pavolmarko@733: pavolmarko@733: // FIRST func() call pavolmarko@733: new State_Func_Called(), pavolmarko@733: NULL), "Part 1"); pavolmarko@733: pavolmarko@733: delete g_pInst; pavolmarko@733: FreeOddThunk(); pavolmarko@733: pavolmarko@733: return true; pavolmarko@733: } pavolmarko@733: