drifter01620@184: #include "asm.h" drifter01620@184: drifter01620@184: #ifndef WIN32 drifter01620@184: #define _GNU_SOURCE drifter01620@184: #include drifter01620@184: #include drifter01620@184: drifter01620@184: #define REG_EAX 0 drifter01620@184: #define REG_ECX 1 drifter01620@184: #define REG_EDX 2 drifter01620@184: #define REG_EBX 3 drifter01620@184: drifter01620@184: #define IA32_MOV_REG_IMM 0xB8 // encoding is +r drifter01620@184: #endif drifter01620@184: drifter01620@184: extern void Msg( const char *, ... ); drifter01620@184: drifter01620@184: /** drifter01620@184: * Checks if a call to a fpic thunk has just been written into dest. drifter01620@184: * If found replaces it with a direct mov that sets the required register to the value of pc. drifter01620@184: * drifter01620@184: * @param dest Destination buffer where a call opcode + addr (5 bytes) has just been written. drifter01620@184: * @param pc The program counter value that needs to be set (usually the next address from the source). drifter01620@184: * @noreturn drifter01620@184: */ drifter01620@184: void check_thunks(unsigned char *dest, unsigned char *pc) drifter01620@184: { drifter01620@184: #if defined WIN32 drifter01620@184: return; drifter01620@184: #else drifter01620@184: /* Step write address back 4 to the start of the function address */ drifter01620@184: unsigned char *writeaddr = dest - 4; drifter01620@184: unsigned char *calloffset = *(unsigned char **)writeaddr; drifter01620@184: unsigned char *calladdr = (unsigned char *)(dest + (unsigned int)calloffset); drifter01620@184: drifter01620@184: /* Lookup name of function being called */ drifter01620@184: if ((*calladdr == 0x8B) && (*(calladdr+2) == 0x24) && (*(calladdr+3) == 0xC3)) drifter01620@184: { drifter01620@184: //a thunk maybe? drifter01620@184: char movByte = IA32_MOV_REG_IMM; drifter01620@184: drifter01620@184: /* Calculate the correct mov opcode */ drifter01620@184: switch (*(calladdr+1)) drifter01620@184: { drifter01620@184: case 0x04: drifter01620@184: { drifter01620@184: movByte += REG_EAX; drifter01620@184: break; drifter01620@184: } drifter01620@184: case 0x1C: drifter01620@184: { drifter01620@184: movByte += REG_EBX; drifter01620@184: break; drifter01620@184: } drifter01620@184: case 0x0C: drifter01620@184: { drifter01620@184: movByte += REG_ECX; drifter01620@184: break; drifter01620@184: } drifter01620@184: case 0x14: drifter01620@184: { drifter01620@184: movByte += REG_EDX; drifter01620@184: break; drifter01620@184: } drifter01620@184: default: drifter01620@184: { drifter01620@184: Msg("Unknown thunk: %c\n", *(calladdr+1)); drifter01620@184: break; drifter01620@184: } drifter01620@184: } drifter01620@184: drifter01620@184: /* Move our write address back one to where the call opcode was */ drifter01620@184: writeaddr--; drifter01620@184: drifter01620@184: drifter01620@184: /* Write our mov */ drifter01620@184: *writeaddr = movByte; drifter01620@184: writeaddr++; drifter01620@184: drifter01620@184: /* Write the value - The provided program counter value */ drifter01620@184: *(void **)writeaddr = (void *)pc; drifter01620@184: writeaddr += 4; drifter01620@184: } drifter01620@184: drifter01620@184: return; drifter01620@184: #endif drifter01620@184: } drifter01620@184: drifter01620@184: //if dest is NULL, returns minimum number of bytes needed to be copied drifter01620@184: //if dest is not NULL, it will copy the bytes to dest as well as fix CALLs and JMPs drifter01620@184: //http://www.devmaster.net/forums/showthread.php?t=2311 drifter01620@184: int copy_bytes(unsigned char *func, unsigned char* dest, int required_len) { drifter01620@184: int bytecount = 0; drifter01620@184: drifter01620@184: while(bytecount < required_len && *func != 0xCC) drifter01620@184: { drifter01620@184: // prefixes F0h, F2h, F3h, 66h, 67h, D8h-DFh, 2Eh, 36h, 3Eh, 26h, 64h and 65h drifter01620@184: int operandSize = 4; drifter01620@184: int FPU = 0; drifter01620@184: int twoByte = 0; drifter01620@184: unsigned char opcode = 0x90; drifter01620@184: unsigned char modRM = 0xFF; drifter01620@184: while(*func == 0xF0 || drifter01620@184: *func == 0xF2 || drifter01620@184: *func == 0xF3 || drifter01620@184: (*func & 0xFC) == 0x64 || drifter01620@184: (*func & 0xF8) == 0xD8 || drifter01620@184: (*func & 0x7E) == 0x62) drifter01620@184: { drifter01620@184: if(*func == 0x66) drifter01620@184: { drifter01620@184: operandSize = 2; drifter01620@184: } drifter01620@184: else if((*func & 0xF8) == 0xD8) drifter01620@184: { drifter01620@184: FPU = *func; drifter01620@184: if (dest) drifter01620@184: *dest++ = *func++; drifter01620@184: else drifter01620@184: func++; drifter01620@184: bytecount++; drifter01620@184: break; drifter01620@184: } drifter01620@184: drifter01620@184: if (dest) drifter01620@184: *dest++ = *func++; drifter01620@184: else drifter01620@184: func++; drifter01620@184: bytecount++; drifter01620@184: } drifter01620@184: drifter01620@184: // two-byte opcode byte drifter01620@184: if(*func == 0x0F) drifter01620@184: { drifter01620@184: twoByte = 1; drifter01620@184: if (dest) drifter01620@184: *dest++ = *func++; drifter01620@184: else drifter01620@184: func++; drifter01620@184: bytecount++; drifter01620@184: } drifter01620@184: drifter01620@184: // opcode byte drifter01620@184: opcode = *func++; drifter01620@184: if (dest) *dest++ = opcode; drifter01620@184: bytecount++; drifter01620@184: drifter01620@184: // mod R/M byte drifter01620@184: modRM = 0xFF; drifter01620@184: if(FPU) drifter01620@184: { drifter01620@184: if((opcode & 0xC0) != 0xC0) drifter01620@184: { drifter01620@184: modRM = opcode; drifter01620@184: } drifter01620@184: } drifter01620@184: else if(!twoByte) drifter01620@184: { drifter01620@184: if((opcode & 0xC4) == 0x00 || drifter01620@184: ((opcode & 0xF4) == 0x60 && ((opcode & 0x0A) == 0x02 || (opcode & 0x09) == 0x09)) || drifter01620@184: (opcode & 0xF0) == 0x80 || drifter01620@184: ((opcode & 0xF8) == 0xC0 && (opcode & 0x0E) != 0x02) || drifter01620@184: (opcode & 0xFC) == 0xD0 || drifter01620@184: (opcode & 0xF6) == 0xF6) drifter01620@184: { drifter01620@184: modRM = *func++; drifter01620@184: if (dest) *dest++ = modRM; drifter01620@184: bytecount++; drifter01620@184: } drifter01620@184: } drifter01620@184: else drifter01620@184: { drifter01620@184: if(((opcode & 0xF0) == 0x00 && (opcode & 0x0F) >= 0x04 && (opcode & 0x0D) != 0x0D) || drifter01620@184: (opcode & 0xF0) == 0x30 || drifter01620@184: opcode == 0x77 || drifter01620@184: (opcode & 0xF0) == 0x80 || drifter01620@184: ((opcode & 0xF0) == 0xA0 && (opcode & 0x07) <= 0x02) || drifter01620@184: (opcode & 0xF8) == 0xC8) drifter01620@184: { drifter01620@184: // No mod R/M byte drifter01620@184: } drifter01620@184: else drifter01620@184: { drifter01620@184: modRM = *func++; drifter01620@184: if (dest) *dest++ = modRM; drifter01620@184: bytecount++; drifter01620@184: } drifter01620@184: } drifter01620@184: drifter01620@184: // SIB drifter01620@184: if((modRM & 0x07) == 0x04 && drifter01620@184: (modRM & 0xC0) != 0xC0) drifter01620@184: { drifter01620@184: if (dest) drifter01620@184: *dest++ = *func++; //SIB drifter01620@184: else drifter01620@184: func++; drifter01620@184: bytecount++; drifter01620@184: } drifter01620@184: drifter01620@184: // mod R/M displacement drifter01620@184: drifter01620@184: // Dword displacement, no base drifter01620@184: if((modRM & 0xC5) == 0x05) { drifter01620@184: if (dest) { drifter01620@184: *(unsigned int*)dest = *(unsigned int*)func; drifter01620@184: dest += 4; drifter01620@184: } drifter01620@184: func += 4; drifter01620@184: bytecount += 4; drifter01620@184: } drifter01620@184: drifter01620@184: // Byte displacement drifter01620@184: if((modRM & 0xC0) == 0x40) { drifter01620@184: if (dest) drifter01620@184: *dest++ = *func++; drifter01620@184: else drifter01620@184: func++; drifter01620@184: bytecount++; drifter01620@184: } drifter01620@184: drifter01620@184: // Dword displacement drifter01620@184: if((modRM & 0xC0) == 0x80) { drifter01620@184: if (dest) { drifter01620@184: *(unsigned int*)dest = *(unsigned int*)func; drifter01620@184: dest += 4; drifter01620@184: } drifter01620@184: func += 4; drifter01620@184: bytecount += 4; drifter01620@184: } drifter01620@184: drifter01620@184: // immediate drifter01620@184: if(FPU) drifter01620@184: { drifter01620@184: // Can't have immediate operand drifter01620@184: } drifter01620@184: else if(!twoByte) drifter01620@184: { drifter01620@184: if((opcode & 0xC7) == 0x04 || drifter01620@184: (opcode & 0xFE) == 0x6A || // PUSH/POP/IMUL drifter01620@184: (opcode & 0xF0) == 0x70 || // Jcc drifter01620@184: opcode == 0x80 || drifter01620@184: opcode == 0x83 || drifter01620@184: (opcode & 0xFD) == 0xA0 || // MOV drifter01620@184: opcode == 0xA8 || // TEST drifter01620@184: (opcode & 0xF8) == 0xB0 || // MOV drifter01620@184: (opcode & 0xFE) == 0xC0 || // RCL drifter01620@184: opcode == 0xC6 || // MOV drifter01620@184: opcode == 0xCD || // INT drifter01620@184: (opcode & 0xFE) == 0xD4 || // AAD/AAM drifter01620@184: (opcode & 0xF8) == 0xE0 || // LOOP/JCXZ drifter01620@184: opcode == 0xEB || drifter01620@184: (opcode == 0xF6 && (modRM & 0x30) == 0x00)) // TEST drifter01620@184: { drifter01620@184: if (dest) drifter01620@184: *dest++ = *func++; drifter01620@184: else drifter01620@184: func++; drifter01620@184: bytecount++; drifter01620@184: } drifter01620@184: else if((opcode & 0xF7) == 0xC2) // RET drifter01620@184: { drifter01620@184: if (dest) { drifter01620@184: *(unsigned short*)dest = *(unsigned short*)func; drifter01620@184: dest += 2; drifter01620@184: } drifter01620@184: func += 2; drifter01620@184: bytecount += 2; drifter01620@184: } drifter01620@184: else if((opcode & 0xFC) == 0x80 || drifter01620@184: (opcode & 0xC7) == 0x05 || drifter01620@184: (opcode & 0xF8) == 0xB8 || drifter01620@184: (opcode & 0xFE) == 0xE8 || // CALL/Jcc drifter01620@184: (opcode & 0xFE) == 0x68 || drifter01620@184: (opcode & 0xFC) == 0xA0 || drifter01620@184: (opcode & 0xEE) == 0xA8 || drifter01620@184: opcode == 0xC7 || drifter01620@184: (opcode == 0xF7 && (modRM & 0x30) == 0x00)) drifter01620@184: { drifter01620@184: if (dest) { drifter01620@184: //Fix CALL/JMP offset drifter01620@184: if ((opcode & 0xFE) == 0xE8) { drifter01620@184: if (operandSize == 4) drifter01620@184: { drifter01620@184: *(long*)dest = ((func + *(long*)func) - dest); drifter01620@184: drifter01620@184: //pRED* edit. func is the current address of the call address, +4 is the next instruction, so the value of $pc drifter01620@184: check_thunks(dest+4, func+4); drifter01620@184: } drifter01620@184: else drifter01620@184: *(short*)dest = ((func + *(short*)func) - dest); drifter01620@184: drifter01620@184: } else { drifter01620@184: if (operandSize == 4) drifter01620@184: *(unsigned long*)dest = *(unsigned long*)func; drifter01620@184: else drifter01620@184: *(unsigned short*)dest = *(unsigned short*)func; drifter01620@184: } drifter01620@184: dest += operandSize; drifter01620@184: } drifter01620@184: func += operandSize; drifter01620@184: bytecount += operandSize; drifter01620@184: drifter01620@184: } drifter01620@184: } drifter01620@184: else drifter01620@184: { drifter01620@184: if(opcode == 0xBA || // BT drifter01620@184: opcode == 0x0F || // 3DNow! drifter01620@184: (opcode & 0xFC) == 0x70 || // PSLLW drifter01620@184: (opcode & 0xF7) == 0xA4 || // SHLD drifter01620@184: opcode == 0xC2 || drifter01620@184: opcode == 0xC4 || drifter01620@184: opcode == 0xC5 || drifter01620@184: opcode == 0xC6) drifter01620@184: { drifter01620@184: if (dest) drifter01620@184: *dest++ = *func++; drifter01620@184: else drifter01620@184: func++; drifter01620@184: } drifter01620@184: else if((opcode & 0xF0) == 0x80) // Jcc -i drifter01620@184: { drifter01620@184: if (dest) { drifter01620@184: if (operandSize == 4) drifter01620@184: *(unsigned long*)dest = *(unsigned long*)func; drifter01620@184: else drifter01620@184: *(unsigned short*)dest = *(unsigned short*)func; drifter01620@184: drifter01620@184: dest += operandSize; drifter01620@184: } drifter01620@184: func += operandSize; drifter01620@184: bytecount += operandSize; drifter01620@184: } drifter01620@184: } drifter01620@184: } drifter01620@184: drifter01620@184: return bytecount; drifter01620@184: } drifter01620@184: drifter01620@184: //insert a specific JMP instruction at the given location drifter01620@184: void inject_jmp(void* src, void* dest) { drifter01620@184: *(unsigned char*)src = OP_JMP; drifter01620@184: *(long*)((unsigned char*)src+1) = (long)((unsigned char*)dest - ((unsigned char*)src + OP_JMP_SIZE)); drifter01620@184: } drifter01620@184: drifter01620@184: //fill a given block with NOPs drifter01620@184: void fill_nop(void* src, unsigned int len) { drifter01620@184: unsigned char* src2 = (unsigned char*)src; drifter01620@184: while (len) { drifter01620@184: *src2++ = OP_NOP; drifter01620@184: --len; drifter01620@184: } drifter01620@184: } drifter01620@184: drifter01620@184: void* eval_jump(void* src) { drifter01620@184: unsigned char* addr = (unsigned char*)src; drifter01620@184: drifter01620@184: if (!addr) return 0; drifter01620@184: drifter01620@184: //import table jump drifter01620@184: if (addr[0] == OP_PREFIX && addr[1] == OP_JMP_SEG) { drifter01620@184: addr += 2; drifter01620@184: addr = *(unsigned char**)addr; drifter01620@184: //TODO: if addr points into the IAT drifter01620@184: return *(void**)addr; drifter01620@184: } drifter01620@184: drifter01620@184: //8bit offset drifter01620@184: else if (addr[0] == OP_JMP_BYTE) { drifter01620@184: addr = &addr[OP_JMP_BYTE_SIZE] + *(char*)&addr[1]; drifter01620@184: //mangled 32bit jump? drifter01620@184: if (addr[0] == OP_JMP) { drifter01620@184: addr = addr + *(int*)&addr[1]; drifter01620@184: } drifter01620@184: return addr; drifter01620@184: } drifter01620@184: /* drifter01620@184: //32bit offset drifter01620@184: else if (addr[0] == OP_JMP) { drifter01620@184: addr = &addr[OP_JMP_SIZE] + *(int*)&addr[1]; drifter01620@184: } drifter01620@184: */ drifter01620@184: drifter01620@184: return addr; drifter01620@184: } drifter01620@184: /* drifter01620@184: from ms detours package drifter01620@184: static bool detour_is_imported(PBYTE pbCode, PBYTE pbAddress) drifter01620@184: { drifter01620@184: MEMORY_BASIC_INFORMATION mbi; drifter01620@184: VirtualQuery((PVOID)pbCode, &mbi, sizeof(mbi)); drifter01620@184: __try { drifter01620@184: PIMAGE_DOS_HEADER pDosHeader = (PIMAGE_DOS_HEADER)mbi.AllocationBase; drifter01620@184: if (pDosHeader->e_magic != IMAGE_DOS_SIGNATURE) { drifter01620@184: return false; drifter01620@184: } drifter01620@184: drifter01620@184: PIMAGE_NT_HEADERS pNtHeader = (PIMAGE_NT_HEADERS)((PBYTE)pDosHeader + drifter01620@184: pDosHeader->e_lfanew); drifter01620@184: if (pNtHeader->Signature != IMAGE_NT_SIGNATURE) { drifter01620@184: return false; drifter01620@184: } drifter01620@184: drifter01620@184: if (pbAddress >= ((PBYTE)pDosHeader + drifter01620@184: pNtHeader->OptionalHeader drifter01620@184: .DataDirectory[IMAGE_DIRECTORY_ENTRY_IAT].VirtualAddress) && drifter01620@184: pbAddress < ((PBYTE)pDosHeader + drifter01620@184: pNtHeader->OptionalHeader drifter01620@184: .DataDirectory[IMAGE_DIRECTORY_ENTRY_IAT].VirtualAddress + drifter01620@184: pNtHeader->OptionalHeader drifter01620@184: .DataDirectory[IMAGE_DIRECTORY_ENTRY_IAT].Size)) { drifter01620@184: return true; drifter01620@184: } drifter01620@184: return false; drifter01620@184: } drifter01620@184: __except(EXCEPTION_EXECUTE_HANDLER) { drifter01620@184: return false; drifter01620@184: } drifter01620@184: } drifter01620@184: */