LunaHook-mirror/LunaHook/veh_hook.cpp

/**
veh_hook Vectored Exception Handler hooking library
Version: 24-March-2008
**/
// #define WINVER 0x0501
// #define _WIN32_WINNT 0x0501
#include <windows.h>
#include "veh_hook.h"
#include<mutex>
static veh_list_t* list = NULL;
char int3bp[] = "\xCC";
std::mutex  vehlistlock;
bool add_veh_hook(void* origFunc, newFuncType newFunc, DWORD hook_type)
{
    std::lock_guard _(vehlistlock);
    //static veh_list_t* list = NULL;
    DWORD oldProtect;
    if (list == NULL) list = new_veh_list();
    if (list == NULL) return false;
    if(get_veh_node(list,origFunc))return false;
    void* handle = AddVectoredExceptionHandler(1, (PVECTORED_EXCEPTION_HANDLER)veh_dispatch);
    auto newnode = create_veh_node(origFunc, newFunc, handle, hook_type);
    if(newnode==NULL)return false;
    // For memory hooks especially, we need to know the address of the start of the relevant page.
    MEMORY_BASIC_INFORMATION mem_info;
    VirtualQuery(origFunc, &mem_info, sizeof(MEMORY_BASIC_INFORMATION));
    newnode->baseAddr = mem_info.BaseAddress;
    if(!VirtualProtect(origFunc, sizeof(int), PAGE_EXECUTE_READWRITE, &newnode->OldProtect))
    {
        delete newnode;
        return false;
    }
    memcpy((void*)(&newnode->origBaseByte), (const void*)origFunc, sizeof (BYTE));
    memcpy((void*)origFunc, (const void*)&int3bp, sizeof (BYTE));
    VirtualProtect(origFunc, sizeof(int), newnode->OldProtect, &oldProtect);
    insert_veh_node(list, newnode);
    return true;
}
void repair_origin(veh_node_t *node){
    DWORD _p;
    if(!VirtualProtect(node->origFunc, sizeof(int), PAGE_EXECUTE_READWRITE, &_p))
        return;
    memcpy((void*)node->origFunc, (const void*)(&node->origBaseByte), sizeof(char));
    VirtualProtect(node->origFunc, sizeof(int), node->OldProtect, &_p);
}
bool remove_veh_hook(void* origFunc)
{
    std::lock_guard _(vehlistlock);
    if (list == NULL) return false;
    veh_node_t* node = get_veh_node(list, origFunc);
    if (node == NULL) return false;
    repair_origin(node);
    RemoveVectoredExceptionHandler(node->handle);
    return remove_veh_node(list, origFunc) , true;
}

void remove_veh_node(veh_list_t* list, void* origFunc)
{
    veh_node_t* searchnode  = list->head;

    while (searchnode != NULL)
    {
        if (searchnode->origFunc == origFunc)
        {
            if(list->tail==searchnode)
                list->tail=searchnode->last;
            if(list->head==searchnode)
                list->head=searchnode->next;
            if(searchnode->last)
                searchnode->last->next=searchnode->next;
            if(searchnode->next)
                searchnode->next->last=searchnode->last;
            
            delete (searchnode);
            return ;
        }
        searchnode = searchnode->next;
    }
    return ;
}
LONG CALLBACK veh_dispatch(PEXCEPTION_POINTERS ExceptionInfo)
{
    
    DWORD oldProtect;
    void* Addr = ExceptionInfo->ExceptionRecord->ExceptionAddress;
    ULONG Code = ExceptionInfo->ExceptionRecord->ExceptionCode;

    if (Code != STATUS_BREAKPOINT && Code != STATUS_SINGLE_STEP) return EXCEPTION_CONTINUE_SEARCH;
    // Try to find the node associated with the address of the current exception, continue searching for handlers if not found;
    
    if (Code == STATUS_BREAKPOINT )//&& hooktype == VEH_HK_INT3)
    {
        veh_node_t* currnode ;
        {
            std::lock_guard _(vehlistlock);
            currnode  = get_veh_node(list, Addr); 
        }
        if (currnode == NULL) return EXCEPTION_CONTINUE_SEARCH;
        
        if(currnode->newFunc(ExceptionInfo->ContextRecord))
        {
            repair_origin(currnode);
            ExceptionInfo->ContextRecord->EFlags |= 0x100;
        }
        else
        {
            remove_veh_hook(Addr);
        }
    }
    else if (Code == STATUS_SINGLE_STEP )//&& hooktype == VEH_HK_INT3)
    {
        std::lock_guard _(vehlistlock);
        veh_node_t* currnode  = get_veh_node(list, Addr, 0x10); 
        if (currnode == NULL) return EXCEPTION_CONTINUE_SEARCH;
        
        VirtualProtect(Addr, sizeof(int), PAGE_EXECUTE_READWRITE, &currnode->OldProtect);
        memcpy((void*)currnode->origFunc, (const void*)&int3bp, sizeof (BYTE));
        VirtualProtect(Addr, sizeof(int), currnode->OldProtect, &oldProtect);
        ExceptionInfo->ContextRecord->EFlags &= ~0x00000100; // Remove TRACE from EFLAGS
        
    }
    // else if (Code == STATUS_SINGLE_STEP && hooktype == VEH_HK_HW)
    // {
    //     currnode->newFunc(ExceptionInfo->ContextRecord);
    // }
    // else if (Code == STATUS_SINGLE_STEP && hooktype == VEH_HK_MEM)
    // {

    //     currnode->newFunc(ExceptionInfo->ContextRecord);
    // }
    return EXCEPTION_CONTINUE_EXECUTION;
}

veh_list_t* new_veh_list()
{
    veh_list_t* newlist = (veh_list_t*)malloc(sizeof(veh_list_t));
    if (newlist == NULL) return NULL;
    newlist->head = NULL;
    newlist->tail = NULL;
    return newlist;
}
veh_node_t* create_veh_node(void* origFunc, newFuncType newFunc, void* handle, DWORD hook_type)
{
    veh_node_t* newnode = new veh_node_t;
    if (newnode == NULL) return NULL;
    newnode->last=NULL;
    newnode->origFunc = origFunc;
    newnode->newFunc = newFunc;
    newnode->handle = handle;
    newnode->OldProtect = PAGE_EXECUTE_READWRITE;
    newnode->next = NULL;
    newnode->hooktype=hook_type;
    return newnode;
}
void insert_veh_node(veh_list_t* list, veh_node_t* newnode)
{
    if (list == NULL) return;
    if (list->head == NULL)
    {
        list->head = newnode;
        list->tail = newnode;
    }
    else
    {
        list->tail->next = newnode;
        newnode->last=list->tail;
        list->tail = newnode;
    }
}
veh_node_t* get_veh_node(veh_list_t* list, void* origFunc, int range)
{
    veh_node_t* newnode;
    veh_node_t* closestnode = NULL;
    if (list == NULL) return NULL;
    newnode = list->head;
    while (newnode != NULL)
    {
        if(((uintptr_t)origFunc-(uintptr_t)newnode->origFunc)<=range)
        {
            closestnode=newnode;
            if(range==0)break;
            range=((uintptr_t)origFunc-(uintptr_t)newnode->origFunc);
        }
        newnode = newnode->next;
    }
    return closestnode;
}