micetools/src/micetools/dll/util/misc.c

// Windows XP does not have RtlCaptureStackBackTrace. This is an awful workaround.
// TODO: Reimplement this ourselves so we can print stacks on XP
#undef _WIN32_WINNT
#define _WIN32_WINNT 0x0600
#include <Windows.h>
#include <dbghelp.h>

#include "../hooks/files.h"

void PrintStack(void) {
    unsigned int i;
    void* stack[100];
    unsigned short frames;
    SYMBOL_INFO* symbol;
    HANDLE process;

    process = GetCurrentProcess();

    SymInitialize(process, NULL, TRUE);

    frames = CaptureStackBackTrace(0, 100, stack, NULL);
    symbol = (SYMBOL_INFO*)calloc(sizeof(SYMBOL_INFO) + 256 * sizeof(char), 1);
    symbol->MaxNameLen = 255;
    symbol->SizeOfStruct = sizeof(SYMBOL_INFO);

    for (i = 0; i < frames; i++) {
        SymFromAddr(process, (DWORD64)(stack[i]), 0, symbol);
        printf("%i: %s - 0x%0X\n", frames - i - 1, symbol->Name, (unsigned int)symbol->Address);
    }

    free(symbol);
}

BOOL FileOrFolderExistsW(const wchar_t* szPath) {
    DWORD dwAttrib = _GetFileAttributesW(szPath);
    return (dwAttrib != INVALID_FILE_ATTRIBUTES);
}
BOOL FileExistsW(const wchar_t* szPath) {
    DWORD dwAttrib = _GetFileAttributesW(szPath);
    return (dwAttrib != INVALID_FILE_ATTRIBUTES && !(dwAttrib & FILE_ATTRIBUTE_DIRECTORY));
}
BOOL FileExistsA(const char* szPath) {
    wchar_t szPathW[MAX_PATH + 1];
    MultiByteToWideChar(0, 0, szPath, -1, szPathW, _countof(szPathW));
    DWORD dwAttrib = _GetFileAttributesW(szPathW);
    return (dwAttrib != INVALID_FILE_ATTRIBUTES && !(dwAttrib & FILE_ATTRIBUTE_DIRECTORY));
}

typedef struct HANDLE_DATA {
    BOOL m_bOccupied;
    PVOID m_pData;
    BOOL m_IsOnHeap;
} HANDLE_DATA, *PHANDLE_DATA;
MICE_DA_NEW(g_handleData, HANDLE_DATA)

PVOID GetDataForHandle(HANDLE hObject) {
    if (hObject == INVALID_HANDLE_VALUE) return NULL;
    if (!hObject & MICE_HANDLE_MASK) return NULL;

    DWORD_PTR dwIndex = (DWORD_PTR)hObject >> 2;
    PHANDLE_DATA found = MiceDAGet(g_handleData, dwIndex);
    if (found == NULL) return NULL;

    return found->m_pData;
}
void SetDataForHandle(HANDLE hObject, PVOID pData, BOOL isHeap) {
    if (hObject == INVALID_HANDLE_VALUE) return;
    if (!hObject & MICE_HANDLE_MASK) return;

    DWORD_PTR dwIndex = (DWORD_PTR)hObject >> 2;
    if (dwIndex < g_handleData->m_Length) {
        PHANDLE_DATA found = MiceDAGet(g_handleData, dwIndex);
        if (found) {
            found->m_bOccupied = TRUE;
            if (found->m_IsOnHeap && found->m_pData) free(found->m_pData);
            found->m_pData = pData;
            found->m_IsOnHeap = isHeap;
            return;
        }
    }

    HANDLE_DATA newHandleData = {
        .m_bOccupied = TRUE,
        .m_pData = pData,
        .m_IsOnHeap = isHeap,
    };
    MiceDAGrowAndSet(g_handleData, dwIndex, &newHandleData);
}
BOOL RemoveDataForHandle(HANDLE hObject) {
    if (hObject == INVALID_HANDLE_VALUE) return FALSE;
    if (!hObject & MICE_HANDLE_MASK) return FALSE;
    DWORD_PTR dwIndex = (DWORD_PTR)hObject >> 2;

    PHANDLE_DATA found = MiceDAGet(g_handleData, dwIndex);
    if (found) {
        if (found->m_IsOnHeap && found->m_pData) free(found->m_pData);
        found->m_pData = NULL;
        found->m_bOccupied = FALSE;
    }
    return TRUE;
}

HANDLE GetDummyHandle() {
    MICE_DA_ITER(g_handleData, HANDLE_DATA, i) {
        if (!i->m_bOccupied) {
            i->m_bOccupied = TRUE;
            return (HANDLE)((MICE_DA_INDEX(g_handleData) << 2) | MICE_HANDLE_MASK);
        }
    }
    MICE_DA_ITER_END

    HANDLE_DATA newHandleData = {
        .m_bOccupied = TRUE,
        .m_pData = NULL,
        .m_IsOnHeap = FALSE,
    };
    MiceDAPush(g_handleData, &newHandleData);
    return (HANDLE)(((g_handleData->m_Length - 1) << 2) | MICE_HANDLE_MASK);
}

void BytesToHex(char* hex_buffer, BYTE* bytes, DWORD nbytes) {
    for (size_t i = 0; i < nbytes; i++) {
        sprintf_s(hex_buffer + i * 3, RSIZE_MAX, "%02x ", bytes[i]);
    }
    hex_buffer[nbytes * 3] = '\0';
}

void make_dirs(const char* path) {
    int count = 0;
    size_t i;
    size_t len = strlen(path);
    char* temp = malloc(len + 1);
    memcpy(temp, path, len + 1);

    for (i = 0; i < len; i++) {
        if (temp[i] == '/' || temp[i] == '\\') count++;
    }
    // Don't create directories for trailing slashes
    if (count && i && (temp[i - 1] == '/' || temp[i - 1] == '\\')) {
        count--;
    }
    if (count == 0) {
        free(temp);
        return;
    }

    for (i = 0; i < len && count; i++) {
        if (temp[i] == '/' || temp[i] == '\\') {
            temp[i] = '\0';
            CreateDirectory(temp, NULL);
            temp[i] = '\\';
            count--;
        }
    }
    free(temp);
}

void* open_mapped_file(LPCSTR lpFilename, DWORD size, HANDLE* file, HANDLE* file_mapping) {
    // char szFileName[MAX_PATH] = { 0 };
    // WideCharToMultiByte(CP_ACP, 0, lpFilename, wcslen(lpFilename), szFileName,
    //                     size2int(sizeof szFileName), NULL, NULL);
    make_dirs(lpFilename);

    *file = _CreateFileA(lpFilename, GENERIC_READ | GENERIC_WRITE,
                         FILE_SHARE_READ | FILE_SHARE_WRITE | FILE_SHARE_DELETE, NULL, OPEN_ALWAYS,
                         FILE_ATTRIBUTE_NORMAL, NULL);
    if (*file == INVALID_HANDLE_VALUE) {
        log_error(plfMisc, "Failed to CreateFileW(%s): %d", lpFilename, GetLastError());
        return NULL;
    }

    *file_mapping = CreateFileMappingW(*file, NULL, PAGE_READWRITE, 0, size, NULL);

    if (*file_mapping == INVALID_HANDLE_VALUE) {
        CloseHandle(*file);
        *file = INVALID_HANDLE_VALUE;

        log_error(plfMisc, "Failed to CreateFileMappingW: %d", GetLastError());
        return NULL;
    }

    SetLastError(0);
    void* mapping = MapViewOfFile(*file_mapping, FILE_MAP_ALL_ACCESS, 0, 0, size);
    if (mapping == NULL || GetLastError()) {
        log_error(plfMisc, "Failed to MapViewOfFileEx: %d", GetLastError());
        CloseHandle(*file);
        CloseHandle(*file_mapping);
        *file = INVALID_HANDLE_VALUE;
        *file_mapping = INVALID_HANDLE_VALUE;
        return NULL;
    }
    return mapping;
}