pavolmarko@733: /* ======== SourceHook ======== pavolmarko@733: * Copyright (C) 2004-2010 Metamod:Source Development Team pavolmarko@733: * No warranties of any kind pavolmarko@733: * pavolmarko@733: * License: zlib/libpng pavolmarko@733: * pavolmarko@733: * Author(s): Pavol "PM OnoTo" Marko pavolmarko@733: * ============================ pavolmarko@733: */ pavolmarko@733: pavolmarko@733: #include "sourcehook_impl.h" pavolmarko@733: pavolmarko@733: namespace SourceHook pavolmarko@733: { pavolmarko@733: namespace Impl pavolmarko@733: { pavolmarko@733: CPageAlloc CVfnPtr::ms_AlignedPageAllocator(8); pavolmarko@733: pavolmarko@733: CVfnPtr::CVfnPtr(void *ptr) pavolmarko@733: : m_Ptr(ptr), m_OrigEntry(*reinterpret_cast(m_Ptr)), pavolmarko@733: m_OrigCallThunk(NULL) pavolmarko@733: { pavolmarko@733: } pavolmarko@733: pavolmarko@733: CVfnPtr::~CVfnPtr() pavolmarko@733: { pavolmarko@733: if (!m_HookMans.empty()) pavolmarko@733: m_HookMans.front()->DecrRef(this); pavolmarko@733: } pavolmarko@733: pavolmarko@733: bool CVfnPtr::Init() pavolmarko@733: { pavolmarko@733: // Initalize the vfn ptr info object. pavolmarko@733: pavolmarko@733: // If we're running on GCC and the original vtable entry is odd pavolmarko@733: // we have a problem. pavolmarko@733: // The hook functions use non-virtual member function pointers to pavolmarko@733: // call the original function (see sourcehook.hxx, SH_SETUP_MFP and SH_CALL_ORIG) pavolmarko@733: // GCC has the same format for virtual and non-virtual MFPs: pavolmarko@733: // virtual ones have an odd value as "funcptr" where the offset into the vtable is encoded pavolmarko@733: // non-virtual ones have the direct function pointer as "funcptr", assuming that it is even pavolmarko@733: pavolmarko@733: // When m_OrigEntry is odd, GCC's runtime MFP calling code interpretes it as a virtual pavolmarko@733: // function call though we want to call the function in a non-virtual way pavolmarko@733: // (the original function call mechanism between the pre and post hook loop has to bypass pavolmarko@733: // the virtual calling mechanism in order to call the original function). pavolmarko@733: pavolmarko@733: #if SH_COMP==SH_COMP_GCC pavolmarko@733: if ((((ptrdiff_t)m_OrigEntry) & 1) != 0) pavolmarko@733: { pavolmarko@733: // Odd orig entry. pavolmarko@733: if (SH_PTRSIZE != 4) pavolmarko@733: { pavolmarko@733: // We only have code for IA32 atm! pavolmarko@733: return false; pavolmarko@733: } pavolmarko@733: pavolmarko@733: // Generate a new thunk pavolmarko@733: m_OrigCallThunk = ms_AlignedPageAllocator.Alloc(5); pavolmarko@733: ms_AlignedPageAllocator.SetRW(m_OrigCallThunk); pavolmarko@733: pavolmarko@733: unsigned char* thunkBase = reinterpret_cast(m_OrigCallThunk); pavolmarko@733: *(thunkBase + 0) = 0xE9; // offset jump, immediate operand pavolmarko@733: ptrdiff_t *offsetAddr = reinterpret_cast(thunkBase + 1); pavolmarko@733: pavolmarko@733: // destination = src + offset + 5 pavolmarko@733: // <=> offset = destination - src - 5 pavolmarko@733: *offsetAddr = pavolmarko@733: (reinterpret_cast(m_OrigEntry) - thunkBase) - 5; pavolmarko@733: pavolmarko@733: ms_AlignedPageAllocator.SetRE(m_OrigCallThunk); pavolmarko@733: } pavolmarko@733: #endif pavolmarko@733: return true; pavolmarko@733: } pavolmarko@733: pavolmarko@733: class CVfnPtrOrigThunkCleanup : public ICleanupTask pavolmarko@733: { pavolmarko@733: CPageAlloc *m_Allocator; pavolmarko@733: void *m_AddrToFree; pavolmarko@733: pavolmarko@733: public: pavolmarko@733: CVfnPtrOrigThunkCleanup(CPageAlloc *allocator, void *addrToFree) : pavolmarko@733: m_Allocator(allocator), m_AddrToFree(addrToFree) pavolmarko@733: { pavolmarko@733: } pavolmarko@733: pavolmarko@733: virtual void CleanupAndDeleteThis() pavolmarko@733: { pavolmarko@733: m_Allocator->Free(m_AddrToFree); pavolmarko@733: delete this; pavolmarko@733: } pavolmarko@733: }; pavolmarko@733: pavolmarko@733: ICleanupTask* CVfnPtr::GetCleanupTask() pavolmarko@733: { pavolmarko@733: if (m_OrigCallThunk != NULL) pavolmarko@733: { pavolmarko@733: return new CVfnPtrOrigThunkCleanup(&ms_AlignedPageAllocator, m_OrigCallThunk); pavolmarko@733: } pavolmarko@733: else pavolmarko@733: { pavolmarko@733: return NULL; pavolmarko@733: } pavolmarko@733: } pavolmarko@733: pavolmarko@733: void* CVfnPtr::GetOrigCallAddr() const pavolmarko@733: { pavolmarko@733: if (m_OrigCallThunk) pavolmarko@733: { pavolmarko@733: return m_OrigCallThunk; pavolmarko@733: } pavolmarko@733: else pavolmarko@733: { pavolmarko@733: return m_OrigEntry; pavolmarko@733: } pavolmarko@733: } pavolmarko@733: pavolmarko@733: bool CVfnPtr::Revert() pavolmarko@733: { pavolmarko@733: // Only patch the vfnptr back if the module is still in memory pavolmarko@733: // If it's not, do not remove stuff like we did before pavolmarko@733: // First off we did it wrong (shutdown the whole hookman, uh..) and secondly applications may be pavolmarko@733: // confused by RemoveHook returning false then (yeah, I know, I made this one up, no one checks for RemoveHook error) pavolmarko@733: if (ModuleInMemory(reinterpret_cast(m_Ptr), SH_PTRSIZE)) pavolmarko@733: { pavolmarko@733: return Patch(m_OrigEntry); pavolmarko@733: } pavolmarko@733: else pavolmarko@733: { pavolmarko@733: return true; pavolmarko@733: } pavolmarko@733: } pavolmarko@733: pavolmarko@733: CIface *CVfnPtr::FindIface(void *iface) pavolmarko@733: { pavolmarko@733: List::iterator iter = m_IfaceList.find(iface); pavolmarko@733: if (iter == m_IfaceList.end()) pavolmarko@733: return NULL; pavolmarko@733: else pavolmarko@733: return &(*iter); pavolmarko@733: } pavolmarko@733: pavolmarko@733: void CVfnPtr::AddHookMan(CHookManager *pHookMan) pavolmarko@733: { pavolmarko@733: List::iterator iter; pavolmarko@733: pavolmarko@733: // Don't accept invalid hook managers pavolmarko@733: if (!*pHookMan) pavolmarko@733: return; pavolmarko@733: pavolmarko@733: // Check whether this hook manager already exists; if yes, ignore. pavolmarko@733: iter = m_HookMans.find(pHookMan); pavolmarko@733: if (iter != m_HookMans.end()) pavolmarko@733: return; pavolmarko@733: pavolmarko@733: // It doesn't -> add it. Add it to the end of its version group. pavolmarko@733: for (iter = m_HookMans.begin(); iter != m_HookMans.end(); ++iter) pavolmarko@733: { pavolmarko@733: if ((*iter)->GetVersion() < pHookMan->GetVersion()) pavolmarko@733: break; pavolmarko@733: } pavolmarko@733: pavolmarko@733: bool isBeginning = iter == m_HookMans.begin(); pavolmarko@733: pavolmarko@733: m_HookMans.insert(iter, pHookMan); pavolmarko@733: pavolmarko@733: if (isBeginning) pavolmarko@733: { pavolmarko@733: pHookMan->IncrRef(this); pavolmarko@733: if (m_HookMans.size() > 1) pavolmarko@733: { pavolmarko@733: // If another hookman was used until now but this one is better pavolmarko@733: // (which it is because it's the first -> it has a higher version) pavolmarko@733: // -> switch! pavolmarko@733: pavolmarko@733: List::iterator second = m_HookMans.begin(); pavolmarko@733: ++second; pavolmarko@733: pavolmarko@733: (*second)->DecrRef(this); pavolmarko@733: } pavolmarko@733: pavolmarko@733: // Make sure that this vfnptr points at it pavolmarko@733: Patch(pHookMan->GetHookFunc()); pavolmarko@733: } pavolmarko@733: } pavolmarko@733: pavolmarko@733: bool CVfnPtr::HookManRemoved(CHookManager *pHookMan) pavolmarko@733: { pavolmarko@733: // Don't accept invalid hook managers pavolmarko@733: if (!*pHookMan) pavolmarko@733: return true; pavolmarko@733: pavolmarko@733: List::iterator iter = m_HookMans.find(pHookMan); pavolmarko@733: if (iter == m_HookMans.end()) pavolmarko@733: return true; // Didn't exist here anyway pavolmarko@733: pavolmarko@733: if (iter == m_HookMans.begin()) pavolmarko@733: { pavolmarko@733: // It is the first one! pavolmarko@733: pHookMan->DecrRef(this); pavolmarko@733: m_HookMans.erase(iter); pavolmarko@733: pavolmarko@733: if (m_HookMans.empty()) pavolmarko@733: return false; // No more hookmans -> let SH delete us pavolmarko@733: pavolmarko@733: // Activate second -> now first hookman pavolmarko@733: m_HookMans.front()->IncrRef(this); pavolmarko@733: Patch(m_HookMans.front()->GetHookFunc()); pavolmarko@733: } pavolmarko@733: else pavolmarko@733: { pavolmarko@733: m_HookMans.erase(iter); pavolmarko@733: } pavolmarko@733: return true; pavolmarko@733: } pavolmarko@733: pavolmarko@733: bool CVfnPtr::Patch(void *newValue) pavolmarko@733: { dvander@767: if (!MakePageWritable(m_Ptr)) pavolmarko@733: { pavolmarko@733: return false; pavolmarko@733: } pavolmarko@733: pavolmarko@733: *reinterpret_cast(m_Ptr) = newValue; pavolmarko@733: pavolmarko@733: return true; pavolmarko@733: } pavolmarko@733: pavolmarko@733: CIface &CVfnPtr::GetIface(void *iface) pavolmarko@733: { pavolmarko@733: List::iterator iter = m_IfaceList.find(iface); pavolmarko@733: if (iter == m_IfaceList.end()) pavolmarko@733: { pavolmarko@733: CIface newIface(iface); pavolmarko@733: if (iface == NULL) pavolmarko@733: { pavolmarko@733: m_IfaceList.push_front(newIface); pavolmarko@733: return m_IfaceList.front(); pavolmarko@733: } pavolmarko@733: else pavolmarko@733: { pavolmarko@733: m_IfaceList.push_back(newIface); pavolmarko@733: return m_IfaceList.back(); pavolmarko@733: } pavolmarko@733: } pavolmarko@733: else pavolmarko@733: { pavolmarko@733: return *iter; pavolmarko@733: } pavolmarko@733: } pavolmarko@733: } pavolmarko@733: }